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Ahtfract 


In  this  report  the  approach  developed  by  the  authors,  for  systematically  studying  the 
acceleration  capabilities  and  acceleration  properties  of  the  end-effector  of  a  planar  2  degree-of- 
freedom  manipulator,  is  extended  to  the  general  spatial  manipulator  with  three  degrees-of-freedom. 
A  central  feature  of  this  report  is  the  determination  of  the  properties  of  the  quadratic  mapping 
between  the  "joint- velocity"  space  and  the  acceleration  space  of  P  which  then  makes  it  possible  to 
obtain  analytical  solutions  for  most  acceleration  properties  of  interest.  We  show  that  a  fundamental 
way  of  studying  these  quadratic  mappings  is  in  terms  of  the  mapping  of  (input)  line  congruences 
into  (output)  line  congruences. 


1  Introduction 


In  this  paper,  we  apply  the  approach  developed  in  (Desa  and  Kim,  1989-1)  to  the  problem  of  determining 
the  acceleration  capability  and  acceleration  properties  of  (a  reference  point  on)  the  end-effector  of  a  spatial 
three  degree -of-frccdom  manipulator. 

An  informal  statement  of  the  problem  is  as  follows: 

Consider  the  general  three  degree  -of-freedom  revolute-joint  manipulator  shown  schematically  in  Figure 
1.  We  are  interested  in  studying  the  acceleration  of  a  reference  point  P  on  link  3.  (P  is  typically  a  point 
on  the  joint  axis  of  the  end-effector,  the  acceleration  of  P  is  therefore  often  referred  to  as  the  end- 
effector  acceleration).  The  usefulness  of  studying  the  acceleration  of  the  end-effector  has  been  discussed 
in  (Yoshikawa,  1985;  Khatib  and  Burdick,  1987;  Graettinger  and  Krogh,  1988;  Desa  and  Kim,  1989-2; 
Kim,  1989). 

As  shown,  for  example,  in  (Desa  and  Kim,  1989-1),  the  acceleration  capability  of  the  point  P  under 
various  conditions  is  best  described  by  certain  acceleration  sets.  Two  properties  which  are  used,  in  general, 
to  characterize  these  sets  are  the  maximum  possible  magnitude  of  the  acceleration  of  P  and  the  maximum 
magnitude  of  the  acceleration  of  P  which  is  available  in  all  directions.  The  former  property  is  simply 
called  the  maximum  acceleration  of  P  and  the  latter  the  isotropic  acceleration  of  P  (Khatib  and  Burdick, 
1987). 

Acceleration  properties  of  the  end-effector  have  also  been  studied  by  (Yoshikawa,  1985;  Khatib  and 
Burdick,  1987;  Graettinger  and  Krogh,  1988).  The  approach  of  each  of  these  researchers  has  been 
discussed  and  compared  with  our  approach  in  the  paper  (Desa  and  Kim,  1989-1)  and  we  will  not  repeat 
that  discussion  here.  We  will  however  repeat  the  fundamental  hypothesis  underlying  our  approach  which 
is  as  follows.  By  decomposing  the  functional  relationships  between  the  inputs  (actuator  torques  and 
joint  variable  rates)  and  the  output  (acceleration  of  P)  into  two  fundamental  mappings,  a  linear  mapping 
between  actuator  torque  space  and  the  acceleration  space  of  point  P  and  a  quadratic  (nonlinear)  mapping 
between  the  "joint  velocity”  space  and  the  acceleration  space  of  P,  and  by  deriving  the  properties  of  these 
two  mappings,  it  is  possible  to  determine  the  properties  of  all  acceleration  sets  which  are  the  images  of 
the  appropriate  input  sets  under  the  two  fundamental  mappings. 

The  contributions  of  this  paper  are  as  follows: 
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1.  The  central  contribution  of  this  paper  is  the  determination  of  the  properties  of  the  quadratic  mapping 
between  the  joint  velocity  space  and  the  acceleration  space  of  P  which  then  makes  it  possible  to 
obtain  analytical  solutions  for  the  isotropic  acceleration.  We  show  that  a  fundamental  way  of 
developing  the  properties  of  the  quadratic  mappings  of  interest  is  in  terms  of  the  mapping  of  (input) 
line  congruences  into  (output)  line  congruences. 

2.  Closed-form  analytic  expressions  are  obtained  relating  important  acceleration  properties  of  manip¬ 
ulators  to  all  the  manipulator  parameters  and  input  variables  (torques,  joint  variable  rates  or  "joint 
velocities”)  of  interest  (The  only  exception  is  the  maximum  local  acceleration  which  is  specified 
in  terms  of  tight  lower  and  upper  bounds  in  section  6.) 

3.  Necessary  and  sufficient  conditions  for  the  existence  of  isotropic  acceleration  have  been  determined. 
(Earlier  studies  seem  to  implicitly  assume  that  isotropic  acceleration  always  exists.)  These  conditions 
are  stated  explicitly  in  terms  of  manipulator  parameters  and  input  variables. 

4.  Analytical  expressions  are  derived  for  determining  the  maximum  and  isotropic  acceleration  of  the 
end-effector  at  any  (“local”)  configuration  of  the  manipulator. 

We  will  demonstrate  the  application  of  the  theory  to  a  particular  three  degree -of-freedom  spatial 
manipulator.  The  application  of  acceleration  theory  to  problems  in  manipulator  design  has  been  dealt 
with  in  (Desa  and  Kim,  1989-2).  The  next  section,  which  describes  our  approach,  also  provides  the  dual 
function  of  being  a  “road-map”  of  the  paper. 
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2  Description  of  the  approach 


The  approach  for  studying  the  acceleration  of  (a  reference  point  P  on)  the  end-effector,  given  in  (Dcsa 
and  Kim,  1989)  is  as  follows: 

1.  Define  the  input  variables  and  output  variables  of  interest  (subsection  3.1).  The  output  of  interest 
is  the  acceleration  of  the  reference  point  P. 

2.  Define  the  input  sets  of  interest  (subsection  3.1). 

3.  Define  the  input-output  functional  relations.  These  are  obtained  from  the  dynamical  and  kinematical 
equations  of  the  manipulator  (subsection  3.2). 

4.  Define  fundamental  mappings  from  these  functional  relations  (subsection  3.3).  There  are  two 
fundamental  mappings,  a  linear  mapping  and  a  quadratic  mapping. 

5.  Define  the  image  sets  of  the  input  sets  under  the  mappings  obtained  in  step  4  (subsection  3.4). 
These  image  sets  are  the  acceleration  sets  of  interest. 

6.  Define  general  properties  which  can  be  used  to  characterize  (“measure”)  acceleration  sets  (subsection 
3.5). 

7.  Determine  the  properties  of  the  mappings  defined  in  step  4  (section  4). 

8.  Determine  the  acceleration  sets  defined  in  step  5  using  the  properties  of  the  mappings  obtained  in 
step  7  (section  4). 

9.  Determine  the  specific  properties  of  the  acceleration  sets  determined  in  step  8  using  the  “measures" 
or  general  properties  defined  in  step  6  (section  5). 

10.  Determine  the  local  acceleration  properties  for  any  configuration  q  of  the  manipulator  using  the 
properties  of  the  acceleration  sets  obtained  in  step  9  (section  6). 


link  3 


P 


3.1  Manipulator  input  and  output  variables 

Consider  the  general  spatial  three  degree -of-freedom  manipulator  with  three  revolute  joints  shown  schemat¬ 
ically  in  Figure  1.  In  this  subsection,  we  define  the  link  parametus,  the  input  variables,  the  input  sets, 
the  output  variables  and  the  output  sets  for  this  general  spatial  manipulator.  The  manipulator  is  assumed 
to  be  rigid  with  negligible  joint  friction. 

The  manipulator  will  be  described  by  a  set  of  geometric  and  inertia  parameters,  which  will  depend 
on  the  manipulator  type.  The  geometric  and  inertia  parameters  for  the  spatial  three  degree -of- freedom 
manipulator  of  Figure  1  are  also  shown  in  Figure  9  are  enumerated  in  the  Appendix. 

Next,  we  define  the  input  variables,  the  input  constraints  and  the  corresponding  input  sets  of  the 
three  degree -of-freedom  spatial  manipulator.  Let  q\,  qi,  and  <73  denote  the  generalized  coordinates  of  the 
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manipulator  (see  Figure  9),  q\,  qi  and  <73  being  the  joint  variables,  respectively,  at  joints  1,  2,  3.  Define 


A 
q  = 


<7i 

<72 

<73 


(1) 


to  be  the  vector  of  joint  variables;  the  corresponding  vector  space  of  all  q  is  called  the  joint  space.  If 
<JiL  '1  <Ji  <  <tiu,  i-  1.2, 3  (2) 


represents  the  constraint  on  joint  variable  i,  the  workspace  W  of  a  manipulator  is  defined  as 
W  =  {q \<hL  <  Qi  <  QiU,  i  =  1,2,3}. 

Let  q\,  <72,  and  <73  denote  the  joint  variable  rates.  Define 


(3) 


q  = 


<71 

<73 


(4) 


to  be  the  vector  of  the  joint  variable  rates.  If 
I  <7,  l<  Qio,  i-  1,2,3 

denotes  the  constraints  on  the  joint  variable  rates,  then  we  can  define 
F  =  {q|  |  <7;  |<  qu»  1,2,3} 


(5) 


(6) 


to  be  the  set  of  all  the  possible  joint  variable  rate  vectors,  represented  by  regulai  parallelopiped  J\K\L\M\J2KiLiM\ 
in  Figure  2.  (We  will  refer  to  this  parallelopiped  as  the  parallelopiped  F  for  short.) 

Let  rlt  T2,  and  7-3  denote  the  actuator  torques,  respectively,  at  joints  1,  2.  and  3,  and 


A 
T  - 


T\ 
ri 
n 

denotes  the  vector  of  actuator  torque  vectors.  Let 


(7) 


r,  )<  i  =  1,2,3 


(8) 
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F 

Figure  3:  Set  of  the  actuator  torques  of  a  three  degree-of-freedom  manipulator 

denote  the  constraints  on  the  actuator  torques  at  joints  1,  2,  and  3.  Define 

T-  W  I  r>  l<  Tu»  »'  =  1,2,3}  (9) 

as  the  set  of  the  allowable  actuator  torques,  represented  by  regular  parallelopiped  ABCDEFGH  in  Figure 
3.  (We  will  refer  to  this  parallelopiped  as  the  parallelopiped  T  for  short.) 

The  vectors  q,  q  and  r  will  be  referred  to  as  the  input  variables  (more  precisely  the  input  variable 
vectors)  of  the  manipulator.  We  will  also  refer  to  the  vector  q  as  a  configuration  of  the  manipulator. 

Let  (xi ,  X2,  xj)  denote  the  coordinates,  in  a  reference  frame  fixed  to  the  base,  of  a  reference  point  P 
on  link  3  (see  Figure  1)  and  define 


as  the  vector  of  task  coordinates;  the  corresponding  vector  space  of  all  xp  is  called  the  task  space. 


7 


The  velocity  xp  and  the  acceleration  xp  of  the  point  P  of  the  manipulator  are,  respectively,  given  by 


*3 


(II) 


and 


* 2  • 

*3 


(12) 


The  acceleration  of  P,  xp,  is  the  output  variable  of  interest  in  the  present  work.  The  corresponding  vector 
space  A  of  all  possible  xp  is  called  the  acceleration  space,  expressed  by 


A  =  {x  t  x  €  fl3}. 


(13) 


3.2  Functional  relations  between  the  inputs  4>  r  and  the  acceleration  xp 

The  next  step  is  to  obtain  the  functional  relations  between  the  acceleration  xp  and  the  inputs  q  and  r 
for  a  given  configuration  q.  In  this  subsection,  we  show  how  the  necessary  functional  relations  can  be 
obtained  from  the  manipulator  dynamic  equations  and  the  (so-called)  manipulator  Jacobian  relationship. 

The  dynamic  behavior  of  the  most  general  three  dcgree-of- freedom  rigid  spatial  manipulator  (Figure 
l)  can  be  written  in  the  following  symbolic  form  (Craig,  1985): 


+  v(q,  4)  +  p  *  r, 


(14) 


where  D  is  the  so-called  mass  matrix  of  the  manipulator,  V(q,  4)  is  the  vector  consisting  of  all  terms 
which  are  non-linear  in  the  products  of  the  joint  variable  rates  <?,,  (i=  1,2,  3),  and  p  is  a  vector  of  all 
terms  due  to  gravity. 

We  next  express  non-linear  terms  V(q,  4)  as  products  of  '.  matrix  and  a  vector.  To  understand  how 
this  is  done,  we  first  write  V(q,  4)  in  its  most  general  expanded  form. 


un<7j  +  un<7§  +  unqf  +  2wuqi<n  +  2'wnqiqi  +  wnftqt 

U21  (j\  +  «22?2  +  M23$3  +  2w21<ft<?2  +  2>V22<?2?3  +  >V23?3?1 

U31  qrf  +  «32<72  +  u33?3  +  2vV31(?i^2  +  2w32<?2<73  +  W33^3  q\ 


(15) 


8 


refining  the  two  matrix  operators, 


“11 

“12 

“13 

“21 

U22 

“23 

K3J 

“32 

«33 

wii 

W12 

VV13 

W21 

W22 

W23 

W31 

W32 

W33 

and  two  vector  operators 

(q)2  =  . 


2q\qi 

[q]2  =  Iq-ifo  i 

2 q\q\ 

we  can  decompose  the  non-linear  term  V(q,  q)  as  follows: 


uu  u\2  “i  3  q\  wn  W12  wt3 

V(q,  q)  =  «21  U22  U23  +  w2\  w22  w2 3  2<72<?3  ^20) 

«31  “32  “33  [  J  [  W31  *32  *33  J  [  2q^q\  _ 

=  U  <  q  >2  +W[q]2.  <21) 

Substituting  equation  (21)  into  (14),  we  can  express  the  dynamic  equation  of  a  general  spatial  manipulator 
by 

Dq  +  U  <  q  >2  +W[q]2  +  p  =  r.  (22) 

This  is  the  most  general  expression  of  describing  the  dynamics  of  a  three  degree-of- freedom  spatial 
manipulator  in  the  joint  space.  The  matrix  D  is  the  mass  matrix  of  the  manipulator  and  the  vector  p 
denotes  the  gravitational  terms  which  influence  the  dynamic  behavior. 


2<7i<?2 

2'qiq-i 

2<73<7t 
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The  relationship  between  the  velocity,  xp,  of  point  P,  and  the  joint  variable  rate  vector  q  is  well  known 
(Desa  and  Roth,  1985): 

x*  =  Jq  (23) 

where  J  is  a  (3  x  3)  matrix  called  the  manipulator  Jacobian.  The  detailed  expression  of  Jacobian  matrix 
is  given  in  the  Appendix. 

To  obtain  the  expression  for  the  acceleration  xp  of  the  point  P,  we  differentiate  equation  (23), 
xp  =  Jq  +  jq.  (24) 

The  second  term  in  equation  (24),  jq,  can  be  written  in  the  form  (see  the  Appendix) 

jq  =  -F  <  q  >2  — G[q]2.  (25) 


Substituting  equations  (25)  into  (24),  we  obtain 

xp  =  Jq  -  F  <  q  >2  -G[q]2.  (26) 


Defining  the  quantities, 

A  =  JD-1, 

(27) 

B  =  -AU  -  F, 

(28) 

N  =  -AW-  G, 

(29) 

(30) 

and 

S  =  -Ap, 

(31) 

we  can  easily  show  that  the  acceleration  xp  of  point  P,  obtained  by  combining  equation  (22)  with  equations 
(26)  through  (31),  is  given  by 

xp  =  At  +  B  <  $  >2  +N[<*]2  +  s  (32) 

where  A,  B,N,  s  are  configuration  dependent  and  have  the  components  tfjj,  bi]t  njj,  jj,  (i,  j  =  1,  2,  3). 
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Equation  (32)  expresses  the  required  (Input-Output)  functional  relation  between  the  input  variables, 
q  and  r,  and  the  acceleration  xp  of  the  point  P  (the  output  variable)  at  a  given  configuration  q.  It  is 
important  to  note  that  the  definition  of  the  matrix  “operators"  U,  W,  F  and  G  and  the  vectors  <  q  >2  and 
[q]2  enables  us  to  write  the  dynamic  equations  in  the  compact  form  (32)  which  is  critical  in  the  sequel. 


3.3  Mappings 


In  this  subsection,  we  define  two  fundamental  mappings  between  the  input  variables  and  the  acceleration 
xp  of  the  point  P  (the  output  variable). 

It  is  convenient  to  regard  the  functional  relation  (32)  as  a  mapping  between  the  input  variables  q  and 
r  and  the  output  variable  Kp  for  a  given  configuration  q  of  the  manipulator.  Furthermore,  defining 


*?  = 

<*\r 

<*2r 

=  At 

and 

q3t 

yP  4 

®lq 

a2q 

=  b  <  q  > 

«3<t  j 

equation  (32)  can  be  written  as 

.2 


(33) 


(34) 


x^x'-t-x^.  (35) 

It  is  convenient  to  think  of  the  vector  x?  as  the  contribution  of  the  torques  to  the  acceleration  of 
the  reference  point  P,  and  the  vector  x^  as  the  contribution  of  the  joint  variable  rates  and  gravity  to 
the  acceleration  of  P.  Equation  (35)  expresses  the  fact  that  the  sum  of  these  two  vectors  gives  us  the 
acceleration  of  P  for  a  three  degree-of-freedom  manipulator. 

Equation  (33)  can  be  viewed  as  a  linear,  configuration-dependent,  mapping  between  the  torque  vector 
r  and  its  contribution  xp  to  the  acceleration  of  P.  Similarly,  equation  (34)  can  be  viewed  as  a  quadratic, 
configuration-dependent,  mapping  between  the  joint  velocity  vector  q  and  its  contribution  x^  to  the 
acceleration  of  P  for  a  given  configuration  q.  These  arc  the  two  mappings  of  interest  in  this  section. 
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3.4  Manipulator  acceleration  sets 

Having  defined  two  fundamental  mappings  of  interest,  we  are  interested  in  the  image  sets  of  the  input  sets 
under  the  mappings  (33)  and  (34)  at  a  given  configuration  q  of  the  manipulator.  There  are  three  image 
sets  of  interest. 


3.4.1  Image  set  ST  of  the  actuator  torque  set  T  under  the  linear  mapping 

For  a  given  set  T  of  the  actuator  torques  r  described  by  equation  (9)  and  represented  graphically  by  a 
regular  parallelopiped  in  the  r  -  space  (see  Figure  3),  we  define  the  image  set  ST  of  T  under  the  linear 
mapping  (33)  as 

Sr  =  {*£|x£  =  Ar,r  £  T}.  (36) 

(Note  that  ST  lies  in  the  acceleration  space  A.) 


3.4.2  Image  set  Sq  of  the  joint  variable  rate  set  F  under  the  quadratic  mapping 

For  a  given  set  F  of  the  joint  variable  rates  q  described  by  equation  (6)  and  represented  graphically  by  a 
regular  parallelopiped  (see  Figure  2),  we  define  the  image  set  Sq  of  F  under  the  quadratic  mapping  as 

5q  =  {*51*5  =  B  <  4  >2  +Nft]2  +  s,  q  G  F}.  (37) 

(Note  that  Sq  lies  in  the  acceleration  space  A.)  From  equation  (34)  and  the  above  definition  (37),  we  sec 
that  the  image  set  Sq  represents  the  set  of  all  possible  accelerations  (the  acceleration  capability  of  the 
manipulator)  when  the  actuators  are  turned  off  (r  =  0)  in  any  configuration  q. 


3.4.3  State  acceleration  set 


When  a  manipulator  is  in  motion,  the  dynamic  state  of  a  manipulator  can  be  specified  by  the  joint  variables, 
(<7i,  <72).  and  joint  variable  rates  (<71,  qi).  The  state  vector  u  which  characterizes  the  dynamic  state  of  the 
manipulator  is  defined  as  follows: 


(38) 
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For  a  specified  dynamic  state  of  a  three  degree-of-freedom  manipulator,  The  second  term  of  the 
acceleration  \p  in  equation  (32)  is  a  constant  vector,  which  we  denote  by  k(u)  and  define  as  follows: 

kx 

k(u)  =  jfe2 
k a 

b\\(j\  +  bn*?!  +  +  2nn<7i<?2  +  2ni2<72<73  +  Innfoqx  +  Si 

+  £22*72  +  £23*73  +  2/121  <?1  <72  +  2/«22<72<73  +  2/t23<73<7l  +  $2 
£31*7?  +  £32*72  +  £33*73  +  2«31<71<72  +  2*32*72*73  +  Innqiqx  +  J3 
=  B  <  q  >2+N[q]2  +  s.  (39) 

Equation  (32)  can  then  be  written  as  follows: 

*  =  Ar  +  k.  (40) 

For  a  given  dynamic  state  u  of  the  manipulator,  we  define  the  state  acceleration  set  Sa  as  the  image  set 
of  T  under  the  linear  mapping  (40): 

Su  =  {x'|x'  =  Ar  +  k,  r  €  T}.  (41) 

Su  is  therefore  the  set  of  all  possible  accelerations  at  any  given  dynamic  state  u  of  the  manipulator.  Since 
the  dynamic  state  u  of  the  manipulator  essentially  specifies  the  velocity  xp  of  the  point  P  in  (1 1)  in  any 
configuration,  we  can  also  interpret  the  state  acceleration  set  Su  (the  set  of  available  accelerations)  as  the 
acceleration  capability  of  the  manipulator  when  the  manipulator  is  moving  with  the  velocity  x^  in  a  given 
configuration  q. 

3.5  Properties  of  the  acceleration  sets 

The  definitions  of  the  acceleration  sets  in  the  previous  subsection  will  be  used  in  section  5  to  determine 
them.  Once  these  sets  have  been  determined,  one  would  like  to  characterize  them. 

Consider  an  acceleration  set  5  in  the  acceleration  space  x,  and  two  spheres  C\  and  C2:  C\  is  the 
smallest  sphere  centered  at  the  origin  which  completely  encloses  the  acceleration  set  and  C2  is  the  largest 
sphere  centered  at  the  origin  which  lies  inside  the  acceleration  set  The  radius  r\  of  the  sphere  C\  is  the 
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maximum  available  acceleration  in  S.  The  radius  r2  of  sphere  2  represents  the  largest  (magnitude  of) 
acceleration  available  in  all  directions. 

We  therefore  define  the  following  two  properties  of  S: 

•  the  maximum  acceleration  of  S:  nmM(S)  =  r\, 

•  the  isotropic  acceleration  of  S:  atta(S)  =  r2. 

Comments: 

The  isotropic  and  maximum  acceleration  are  particularly  attractive  for  characterizing  set  5,  in  contrast 
to  the  average  acceleration,  since  they  can  be  readily  extracted  from  the  dynamic  equations  in  “closed- 
form”  (or  by  appropriate  bounds).  The  average  acceleration,  if  required,  can  be  numerically  determined 
from  the  description  of  the  acceleration  sets  given  in  the  next  section. 
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4  Determination  of  the  acceleration  sets 


Analytic  expressions  for  the  determination  of  the  three  sets  ST,  Sq  and  5U  are  presented,  respectively,  in 
section  4.1,  4.2  and  4.3.  The  determination  of  ST  and  the  state  acceleration  set  5U  follows  direct!  v  from 
well-known  properties  of  linear  mappings  while  the  determination  of  the  set  Sq  requires  the  derivation  of 
the  properties  of  quadratic  mappings  which  are  new  The  approach  for  determining  the  set  Sq  under  the 
quadratic  mapping  is  more  fundamental  than  that  given  in  (Desa  and  Kim,  1989). 


4.1  Determination  of  the  image  set  5r 

The  set  Sr  is  the  image  set  of  the  actuator  torque  set  T  under  the  linear  mapping  (33).  We  determine  the 
image  set  ST  of  the  linear  mapping  of  a  three  degree-of-freedom  manipulator  in  the  x  -  space.  Additionally, 
we  identify  the  boundaries  of  set  ST,  which  are  planes  in  the  x  -  space. 
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Result  1:  The  image  set  ST  of  the  actuator  torque  set  T  under  the  linear  mapping  (34)  is  (the  interior  and 

boundary  of)  the  parallelopiped  A  B' Cf  D' E' F' G  H'  in  the  x-space  whose  vertices  A',  B' . //  are 

as  follows: 

i 

A  :  (aim. +aun. -faun,,  aim.  -t-onn.  asm.  +  asm#  +  anr\,)  (42) 

I 

B  (Juru  —  flurj, +  flun*  -  ^31^*  —  ^32^  +  aj3D»)  (43) 

r 

C  (— «im»  —  ann,  ♦  anrj.,  —aim.  —  <Jnru  +  anrw,  — aim.  —  an  +  03373.)  (44) 

i 

D  (— aim.  +  onn.  +  aurw,  —  aim.  +  ano.  +  ajjri,,  —  ajin«  +  anT2.  +  0331%,)  (45) 

/ 

£  (aim.  +aun»  —  anrj,,  ann.  +aa^»  —  oan.,  ajin«  +  ann.  -  a33rv>)  (46) 

i 

F  (aim.  —  aun,  -  a» tj,,  aun.  —  ann.  -  Oars,,  asm.  —  aan.  —  ours,)  (47) 

/ 

G  (-aim.  —  aun.  -  aun,,  —aun.  —  aan.  —  a»n«,  —asm.  -  aun.  —  ann.)  (48) 

l 

H  (— aim.  +  auT5»  —  aijrj,,  —aun.  +  on +2.  —  arsn.,  —asm.  +  ann,  —  assn.)  (49) 

where  a^,  (ij  =  1,  2,  3),  are  the  elements  of  the  matrix  A.  The  centroid  of  the  parallelopiped 

AB'  ...Hi  is  the  origin  of  the  X-plane  (see  Figure  4). 

Result  2:  The  (planar)  sides  of  the  parallelopiped  ST  arc  given  by  the  following  equations: 

A  B  F  E  (ajjan  —  OaaniSi  —  (aua»  —  anaii)*i  +  (au^n  —  auaa)Xj  =  n.  det(A)  (50) 

I  I  I  I 

D  C  G  H  :  (aaan  —  axs<ta)X i  —  (auOn  —  anan) Xi  +  (auaa  —  ana-n)Xi  =  —  no  det(A)  (51) 

A  D  H  E  — (auajj  —  anan)*i  +(auajj  —  asiasslXi  —  (auau  —  auau)X 3  =  n» det(A)  (52) 

BCGF  (auajj  —  auaji)*i  —  (anan  —  ajiai3)?2  +  (auajj  —  aijajilXj  =  Ti„det(A),  (53) 

A  B  C  D  :  (an an  —  ana3i)*i  —  (an an  -  osiaia)Xi  +  (an an  —  auOn)?!  =  n»  det(A),  (54) 

i  l  i  I 

E  F  G  H  :  (ojjan  —  a22B3i)Jti  —  (auan  —  asiauiii  +  (ana®  —  auanlXs  =  —  n, det(A)  (55) 

where  det(A)  is  the  determinant  of  the  matrix  A. 

The  following  are  well-known  properties  of  a  linear  mapping: 

1.  A  plane  in  the  r-space  will  map  into  a  plane  in  the  x-plane.  In  particular,  planes  p\  (t\  =  0),  p2 
-  0)  and  p 3  (r5  =  0)  map,  respectively,  into  planes  p\,p'i  and  p'3  whose  equations  arc  as  follows: 

/ 

Pi  ■  (d22«33  -  dZ3fl32)Xl  -  (flu® 33  -  a32dl3)*2  +  (d  12^23  -  dl 3^22^3  *  0,  (56) 

I 

Pi  (021^33  “  d23d3l)*l  ~  (dlld33  ~  d3ldl3)X2  +  (and23  ~  dl3d2l)X3  =*  0,  (57) 

Pi  :  (d2ld32  -  d22«3l)Xl  -  (dud32  -  fl3ldl2)*2 +  (dlld22  -  dl2d2l)*3  =*  0.  (58) 
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All  three  planes  p[,  p2  and  p3  pass  through  the  origin  of  the  x-plane. 

2.  Any  plane  g\  parallel  to  pi  maps  into  a  plane  g'i  parallel  to  p\ . 

3.  Any  plane  gi  parallel  to  P2  maps  into  a  plane  g2  parallel  to  p'2. 

4.  Any  plane  g3  parallel  to  pj  maps  into  a  plane  £3  parallel  to  p'^. 


Proof  of  result  1: 

By  regarding  the  rectangular  parallelopiped  AB...H  (set  T)  as  a  set  of  planes  parallel  to  pi,P2  and  pj 
one  can  easily  show  the  well-known  fact  that  the  image  of  AS  . .  .H  is  a  parallelopiped  AB'  ...H'.  The 
vertices  A\  B' , H*  are  the  images,  respectively,  of  the  vertices  A,  B, ....  H  which  are  as  follows: 

/  —  n  N 

T\o 
T2o 

v 

/  —Tio  ^ 

Tlo 

\  ~T1°  ) 

into  equation  (33),  we  obtain  the  coordinates  of  the  vertices  A\  B',  as  given  in  equation  (49). 

From  (49),  we  see  thr  the  vertices  A'  and  G!  are  equidistant  from  the  origin  and  so  are  the  pairs  (fi' ,  //), 
(C\  E')  and  (£>’,  F').  Therefore,  the  origin  of  the  K-space  is  the  centroid  of  the  parallelopiped  A'b' 


f  no ' 

(  > 
no 

-n.  \ 

A 

no 

B 

-no 

c 

-no 

V  / 

V 

/ 

no  N 

'  no > 

(  -no  ^ 

no 

F 

-T2o 

G 

-no 

\  " 

-no  j 

,  -no  / 

(  / 

H 


(59) 


Proof  of  result  2: 

We  next  need  to  determine  the  equation  of  the  planes  A' B' F> f!  ,  D  C'g'H',  ADH'e',  BC'G'f' , 
A  B  C'd'  and  E?F’G'h'  which  form  the  boundary  of  the  parallelopiped  a!b'  ...//  in  the  jt-space.  The 
plane  A  B'f'E1  in  the  "-space  is  the  image  of  the  plane  ABFE  whose  equation  is  n  =  tXo  in  the  r-spacc; 
to  obtain  the  equation  of  A  B  F'Ef,  substitute  the  equation  of  ABFE  (t\  =  t\0)  into  (33)  to  obtain  the 
following  parametric  equations  in  ri  and  r3: 


*1  =  anno  +  012^2  +  ann 


(60) 
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*2 

*3 


&21rlo  +  022*2  +  <*23*5 


(61) 

(62) 


=  d31rl0  +  032^2  +  033^- 

Eliminating  the  parameter  T2  and  between  equations  (60),  (61)  and  (62),  we  obtain  the  equations  of 

the  plane  AB'  F'e'  as  given  by  equation  (50).  In  a  similar  fashion,  we  obtain  the  equations  of  planes 

DC?  G' F? ,  A'D'H’E?  ,  fi'C*  G'  F1 ,  A'b'(?  O' ,  and  E'f'GH'  as  in  equations  (51)  through  (55). 

4.2  Determination  of  the  image  set  Sq 

The  set  Sq  is  the  image  set  of  the  joint  rate  set  F  under  mapping  (34)  for  a  three  degree-of-freedom 

manipulator.  We  decompose  the  set  F  (Figure  5  (a))  into  3  subsets  F\,  F2  and  F3  described  as  follows: 

Definition  1:  The  set  F\  is  the  truncated  line  congruence  (Semple  and  Kneebone,  1952)  consisting  of 
the  doubly  infinite  set  of  line  segments  passing  through  the  origin  with  one  endpoint  on  the  plane 
J\K\M2L2  and  the  other  endpoint  on  the  plane  M\L\J2K2.  A  typical  member  of  F\  is  the  line 
segment  g\  shown  in  Figure  5  (b). 

Definition  2:  The  set  F2  is  the  truncated  line  congruence  consisting  of  the  doubly  infinite  set  of  line 
segments  passing  through  the  origin  with  one  endpoint  on  the  plane  J\L2K2M\  and  the  other 
endpoint  on  the  plane  K \M2J 2^1 .  A  typical  member  of  F2  is  the  line  segment  g2  shown  in  Figure 
5(c). 

Definition  3:  The  set  F3  is  the  truncated  line  congruence  consisting  of  the  doubly  infinite  set  of  line 
segments  passing  through  the  origin  with  one  endpoint  on  the  plane  J\K\L\M\  and  the  other 
endpoint  on  the  plane  LiM2J2K2.  A  typical  member  of  F3  is  the  line  segment  g2  shown  in  Figure 
5(d). 

We  can  now  state  the  useful  results  which  analytically  describe  Sq,  the  image  of  F. 

Result  1: 

l.(a)  Every  line  of  the  type  g\  belonging  to  set  F\  maps  into  a  line  g\  in  the  x-space  (Figure  6  (a)),  one 
endpoint  of  which  is  the  point  S  whose  coordinates  s„  i  =  1,  2,  3  are  given  by  (40)  and  the  other 
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endpoint  of  which  lies  on  the  quadratic  surface  patch  (Figure  6  (b))  whose  parametric  equation  (in 
<72  and  qz)  is: 

*1  bU<t\0  +  +  bU%  +  +  ^12^2^3  +  2^13<?3<?10  +  *1 

*2  =  h21^i<,  +  ih242  +  i’23^  +  2«21<?l»42  +  2n22^2<73  +  2rt23<?3<?lo+J2 

h  &31<7i  „  +  &324l  +  *33^3  +  2/l31?lo$2  +  2/l32<72<73  +  2/l33<73<?lo  +  *3 

where 

~<i\o  <  <72  <  Q2o 
-Q2o  <  <73  <  <73* 

l.(b)  The  set  Fi  maps  into  a  set  (Sq)i  in  the  x-plane  which  is  a  doubly-infinite  system  of  line  segments, 
one  endpoint  of  which  is  the  point  S  with  coordinates  s,  (i  =  1,  2,  3).  given  by  (31)  and  the  other 
endpoint  of  which  lies  on  the  quadratic  surface  described  by  (63). 


Result  2: 

2.(a)  Every  line  of  the  type  gz  belonging  to  the  set  Fz  maps  into  a  line  g'2  in  the  x-space  (see  Figure  6 
(c)),  one  endpoint  of  which  is  the  point  S  and  the  other  endpoint  of  which  lies  on  the  quadratic 
surface  patch  (Figure  6  (d))  whose  parametric  equation  (in  <73  and  <70  is: 

*ll<7l  +  but&o  +  &13<?3  +  2llll4!  <724.  +  2'*t2$2<»$3  +  2«13?39l  +  *i 
bz\  <7?  +  &22<7i>  +  &23<7?  +  2/121  <71  qio  +  2/l22<724,<73  +  2/l23<739l  +  $2 

t>31?l +^2<7i,  + *33^3 +2^31(7!  <724.  +2^324,2«<73  +2«33^3?1  +  *3 

where 

I <7i  I  <  q\o 
\<ti\  <  Hio 

2.(b)  The  set  Fz  maps  into  a  set  (Sq)2  in  the  x-plane  which  is  a  doubly-infinite  system  of  line  segments, 
one  endpoint  of  which  is  the  point  S  and  the  other  endpoint  of  which  lies  on  the  quadratic  surface 

described  by  (64). 
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Result  3: 


3.(a)  Every  line  of  the  type  gj  belonging  to  the  set  Fi  maps  into  a  line  g\  in  the  x-space  (see  Figure  6 
(e)),  one  end  of  which  is  the  point  S  and  the  other  end  of  which  lies  on  the  quadratic  surface  patch 
(Figure  6  (f))  whose  parametric  equation  (in  q\  and  <fr)  is: 


X\ 

+6l2$2  +£l3<?L  +  2nil$l?2  +  2/li2$2$3e  +  2rti3<73o<7i  +ri 

*2 

= 

bllifi  +  bnift  +h234l3a  +2«2l4lC?2  +  2fl22fo<bo  +  2n23&o$l  +  *2 

*3 

&31<Ti  +  &32<?2  +  &33<730  +  2/l3t?l?2  +  2n3202<?3«  +  2/l33<?3o<7l  +  53 

where 


~4io  <  <7t  <  o 

-itlo  <  <n  <  <tlo 


3.(b)  The  set  F3  maps  into  a  set  (Sq>3  in  the  x-plane  which  is  a  doubly-infinite  system  of  line  segments, 
one  endpoint  of  which  is  the  point  S  and  the  other  endpoint  of  which  lies  on  the  quadratic  surface 
described  by  (65). 


Result  4: 

The  image  set  of  Sq  of  the  joint  variable  rate  set  F  is  the  union  of  the  sets  (Sq)i,  (Sq)2,  (Sq)3  described 
above. 


Proof  of  Results  1,  2,  and  3: 

We  will  first  derive  certain  useful  properties  of  the  quadratic  mapping  defined  by  equation  (34): 


xp  =  B  <  >2  +N[4]2  +  s. 
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The  above  equation  can  be  written  in  the  expanded  form 

b\\<j\  +  bi2<?2  +  6i3<7§  +  2flnqi<72  +  2rti2<72?3  +  2ni3<73?i  +  Ji 

*2  -  bl\<i\  +^>22^  +  ^23<73+2«21?t<72  +  2n224293  +  2rt23<73?l  +  *2  (66) 

*3  ^31<?I +^32^2  +  ^33<?3 +2rt3i^ift  +  2n32?2?3  +  2n33q3(7i +S3 

Consider  the  (input)  q-space.  It  is  convenient  to  think  of  this  space  as  being  generated  by  the 
continuous  doubly-infinite  set  of  lines  (also  called  a  line  congruence)  passing  through  the  origin  with 
parametric  equations 

q\-t 

q2  =  m\t  ;  -oo  <  mi  <  oo,  -oo  <  m 2  <  co.  (67) 

<73  =  mit 

Each  value  of  mi  and  m2  gives  us  a  member  of  the  line  congruence,  a  typical  member  of  w  nich  is 
the  line  l  shown  in  Figure  7.  The  image  (  in  the  x-space  of  the  line  /  is  obtained  by  substituting  (67)  into 
(66)  and  is  described  by  the  following  parametric  equations, 

x\  m\  f2  +  S\ 

X2  ~  ni_ it2,  +  S2  (68) 

X3  m^r2  +  S3 

where 

t  7  7 

m,  =  bn  +  bumf  +  bumf  +  2n\\m\  +  2n\2m\m2  +  2n\^m2 

m'2  =  621  +  bn^i  +  b2zm\  +  2«2imi  +  2n22m\m2  +  2^23^2 

t  7  7 

m3  =  i>3 1  +&32mf  +  fam^  +  2/t3imj  +  2rt32mim2  +  2nyim,2- 
From  equation  (67)  and  (68),  one  can  infer  the  following  facts: 

Fact  1.  The  image  of  /,  viz.  ( ,  is  a  straight  line. 

Fact  2.  The  origin  of  the  q-space  maps  into  the  point  S  of  the  x-space. 
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Fact  3.  Two  points  with  coordinates  (fa,  fa,  fa)  and  (-<71,  -<72,  -<73)  map  into  the  same  point  of  the 
S-space. 

These  results  are  shown  graphically  in  Figure  7. 

Fact  1  follows  from  the  fact  that  (68)  is  the  equation  of  a  straight  line  in  the  parameter  z2.  Fact  2 
follows  from  the  fact  that  the  point  (0,  0,  0)  in  the  q-space,  represented  by  the  parameter  /  =  0  in  (67), 
maps  into  the  point  (si.  Si,  S3)  in  the  x-space.  If  r  is  the  parameter  corresponding  to  the  point  (<71,  <72. 
<73)  in  the  q-space,  then,  from  (67),  -t  is  the  parameter  of  the  point  (-<71,  -<72.  -<73)-  From  (68),  we  see 
that  points  with  parameters  t  and  -t  will  map  into  the  same  point  in  the  x-space.  This  proves  Fact  3. 

The  following  two  important  properties  of  the  quadratic  mapping  (33)  (or  (66))  follow  directly  from 
the  above  facts: 

Property  1:  The  image  of  a  line  l  passing  through  the  origin  of  the  q-space  is  the  half-line  t ,  one  endpoint 
of  which  is  the  point  S(s\,si,si)  of  the  x-space  (see  Figure  7  (a)). 

Property  2:  Consider  a  line  segment  g  passing  through  the  origin  of  the  q-space  and  with  endpoints 
f*i(fa,fa,fa)  and  Pi(~q\,  -fa,  -fa)  corresponding,  respectively,  to  parameters  t  and  -r,  g  maps 
into  a  line  segment  g  in  the  x-plane,  with  one  endpoint  at  S(s\,S2,ss)  and  the  other  endpoint  at  Q 
whose  coordinates  arc  given  by  (68)  (see  Fig  6  (b)).  Q  is  the  image  of  both  points  P\  and  Pi. 

Property  1  is  basically  a  statement  of  the  fundamental  “folding”  property  of  the  quadratic  mapping. 
Property  2  is  more  useful  for  our  purposes. 

We  now  determine  the  image,  under  the  mapping  (34),  of  the  set  F\  which  consists  of  the  doubly- 
infinite  system  of  line  segment  of  the  type  gi,  (see  Figure  6  (a)  ),  which  passes  through  the  origin  and 
which  has  endpoints  Pi  and  Pi,  respectively,  on  planes  J\K\MiLi  and  M\L\JiKi  (Figure  6  (a) ). 

The  plane  J\K\MiLi  is  described  by 

fa  =  fao  (69) 

and  the  plane  M\L\JiKi  is  described  by 

fa  =  -  fao-  (70) 
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Therefore,  if  P 1  lying  on  J\K\M^Li  has  coordinates  (q\,q2,qz),  then  P%  lying  on  M\L\JiKi  has 
coordinates  (-$i„,  -  fa,  -qi).  By  property  2  of  the  quadratic  mapping,  the  line  segment  g\  with  endpoints 
P\  and  P2  will  map  into  a  line  segment  with  one  endpoint  at  S(s\,Sz,si)  and  the  other  endpoint  at  Q 
(Figure  7),  which  is  the  image  of  both  P\  and  Pi  and  which  we  need  to  determine  next.  For  every 
point  P\(,q\o,qi,<h)  lying  in  the  plane  J\K\MiLi,  there  is  a  point  Pi{-q\0,  -<ji,  -<73)  lying  in  the  plane 
M\L\JiKi  which,  by  Fact  3  established  above,  has  the  same  image  as  P\.  Therefore,  planes  J\K\MiLi 
and  M\L\hKi  have  the  same  image.  It  is  sufficient  therefore  to  determine  the  image  of  plane  J\K\MiLi. 
Since  plane  J\K\MiLi  is  the  set  of  all  possible  P\,  the  image  of  J\K\MiLz  is  the  set  of  images  of  all 
possible  Pi.  To  obtain  the  image  of  J\K\MiLi,  we  substitute  its  equation  (69  )  into  (66)  to  obtain  (63) 
which,  because  it  is  quadratic  in  the  parameters  q\  and  <72,  represents  a  quadratic  surface  in  the  x-plane. 

The  quadratic  surface  (63)  is  the  image  of  the  plane  M\L\JiKi  as  well  as  the  image  of  the  plane 
J\K\MiLi.  Any  point  P\  of  M\L\JiKi  with  coordinates  (q\0,  <72,  <73)  and  any  point  Pi  of  JiKiMiLi  with 
coordinates  (-ft*.  -qi,  -<73)  will  have  the  same  image  Q  with  coordinates  Qti,  Z2,  xj)  given  by  (68). 

We  have  thus  shown  that  the  line  segment  with  the  endpoints  Pi  and  P2  will  map  into  a  line  segment 
in  the  x-plane  with  one  endpoint  at  S(si,  S2,Si)  and  the  other  endpoint  Q  lying  on  the  quadratic  surface 
(63).  This  completes  Result  1(a). 

It  is  now  a  simple  matter  to  determine  the  image  (Sq)i  of  F\.  By  Result  1(a),  the  doubly-infinite  set  of 
line  segments  F\  of  the  type  g\  with  endpoints  P\{q\0,qi,  qi)  and  Pi(-q\0, -qi,  -qj)  lying,  respectively, 
in  the  planes  M1L1J2K2  and  J\K\MiLi  will  map  into  the  doubly-infinite  set  of  line  segments  (Sq)i  with 
one  endpoint  (always)  at  5  and  the  other  endpoint  on  the  quadratic  surface  (63).  This  completes  the  proof 
of  Result  1(b). 

In  exactly  similar  fashion,  we  can  show  Results  2(a)  and  2(b)  and  Results  3(a)  and  3(b). 

Proof  of  Result  4: 

Since  the  images  of  F \ ,  F2  and  F3  are,  respectively,  (Sq)i,  (Sq)2,  and  (Sq)3,  the  image  of  F  -  F\ U/^uFs 
is  Sq  =  (Sq)i  U  (Sqh  U  (Sqb.  (Sq)i ,  (Sqb  and  (Sqb  have  been  defined,  respectively,  in  Results  1(b),  2(b), 


26 


*2 


Figure  8:  State  acceleration  set  of  a  three  degree-of-frcedom  manipulator 
and  3(b).  This  completes  the  proof  of  Result  2. 

Comment: 

The  analytical  description  of  (Sq)  by  means  of  (Sqh,  (Sqh  and  (S’qb  is  sufficient  for  the  extraction 
of  the  acceleration  properties  which  we  arc  interested  in. 

4.3  Determination  of  the  state  acceleration  set  S„ 

The  state  acceleration  Su  corresponding  to  a  state  u  =  (q,  q)r  of  the  spatial  manipulator  was  defined  by 
equation  (41)  and  is  the  image  set  of  the  actuator  torque  set  T  under  the  mapping  (40).  We  obtain  the 
following  results  for  the  state  acceleration  set  Su. 
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Resuit  1:  For  every  element  x(ST)  of  the  image  set  ST,  there  is  a  corresponding  element  x(S„)  of  the 
state  acceleration  set  Su,  given  by 


*CSu)  =  *(Sr)  +  k(q,  q), 


where 


k(q,<i) 


*1 

*2 

*3 

9u9i  +bi2£?2  +  *i3$3  +  2*u9i92  +  2*u9293  +  2n\iifiq\  +ri 

9219?  +  bvQi  +  fo3%J  +  2*21  $1  92  +  2*229293  +  2*239391  +  *2 
*319?  +^32^  +  t>3393  +  2*3l9l92  +  2*329293  +2*339391  +53 
b  <  q  >2+N[q]2  +  s. 


(71) 


a2> 


Result  2:  The  state  acceleration  set  5U,  corresponding  to  a  state  u  =  (q,  q)T  of  the  spatial  three  degree- 
of-freedom  manipulator  is  the  parallelopiped  A" B"  C" D" E” f"  G" H"  shown  in  Figure  8  obtained  by 
translating  the  set  ST  by  the  vector  k(q,  q)  in  the  x-space.  The  centroid  of  5U  is  (k\,  kz,  h). 


Proof  of  Result  1: 

The  results  1  and  2  are  straightforward. 

From  (36).  a  member  x(Sr)  of  ST  is  given  by 

x(ST)  =  A  r.  (73) 

From  (41),  a  member  x(Su)  of  Su  is  given  by 

x(Su)  =  Ar  +  k  (74) 

where  k  is  given  by  equation  (72).  Combining  (73)  and  (74),  we  obtain 

x(Su)  =  x(ST)  +  k  (75) 

which  is  equation  (71). 


Proof  of  Result  2: 
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From  equation  (71),  we  see  that  if  we  take  a  vector  x(ST)  of  ST  and  add  the  vector  k  to  it  we  obtain 
the  corresponding  member  x(5u)  of  5U.  Therefore,  if  we  add  the  vector  k  to  every  vector  in  the  set  Sr  we 
obtain  the  required  set  Su.  Therefore,  Su  is  the  parallelopiped  a" B" C" D" E" F" G" H"  (Figure  8)  obtained 
by  translating  the  set  ST  (the  parallelopiped  A'  b'  C'  D'  E'  F'  G' H1  in  Figure  8)  by  the  vector  k.  The  centroid 
of  ST  is  x(ST)  =  (0,  0).  From  (75),  we  see  that  the  corresponding  centroid  of  Su  is 

x(5u)  =  0  +  k  =  k.  (76) 

This  completes  the  proof  of  Result  2. 
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5  Properties  of  the  acceleration  sets 

In  this  section,  we  explain  how  to  characterize  the  image  set,  Sr,  Sq,  and  the  state  acceleration  set,  Su. 
using  the  results  in  section  ??. 


5.1  Properties  of  the  acceleration  set  ST 

9 

We  characterize  the  image  set  ST  of  the  linear  mapping  as  follows. 

Result  1:  The  maximum  acceleration  of  the  acceleration  set  Sr  is  denoted  by  Om»x(ST)  and  is  given  by 

=  ma x[d(OA'),  d(OB '),  d(OC'),  d(OD’)]  (77) 

where 

d{OA  )  *  \/ +  dun*  +  +  (dll  n*  +  dan*  +  +  (flit  n®  +  dan®  +  djjn®)* 

d(OB  )  *  \/ (dun.  -  dun*  +  dun,)2  +  (dun*  -  «an.  +  dan.)2  +  (djin.  —  dan®  +  anr w)2 

d(.OC)  *  sf(.  — dun.  —  dun*  ♦  dun®)2  +  (— dun®  —  a an*  ♦dan*)1  +  (— dun®  —  a» n®  +  ann®)2 
d(OD  )  =  vA-^nn®  +  dun®  +dun*)z  +  (-dun.  +  dan®  +  dun®)2  +  (-flun.  +  aun®  +flnn.)J 


Result  2:  The  isotropic  acceleration  of  the  acceleration  set  ST  is  denoted  by  aiIO(5T)  and  is  given  by 

an  =  [p{AB'F'E!),  (KAD'h'e'),  piA  b' d  D )]  (78) 


where 

p{A  B  F  E  ) 
p(AD  HE) 

p(A  B  C  D  ) 


1  det(A)  j  n. 

\/(dad»  —  flzjflja)2  +  (dudxj  —  dijdjj)2  +(duda  —  dnda)2 

|  det(A)  |  n. 

\/(diidjj  -  dndji)2  +  (dudjj  -  auaji)2  +  (dudu  —  dudu)2 

_ 1  det(A)  |  n» _ 

\/(d2idn  —  dudji)2  +(dudn  -  dudji)2  +  (duda  —  dudu)2 


Proof  of  Result  1: 

The  maximum  acceleration  of  ST  is  the  distance  from  the  origin  to  the  furthest  vertex  of  the  par- 
allelopiped  A  B  C1  D  E?F'G  H' .  Letting  d  (O  A')  through  d  ( O  H ')  denote,  respectively,  the  distances  of 
vertices  A'  through  H1  from  the  origin  in  the  x-space,  Om^Sr)  is  given  by 

<WST)  =  ma x[d(0'A),  d(0'B),  . . .  ,d(0'H)].  (79) 
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A'  and  G'  are  equidistant  from  the  origin  O' .  Also,  B‘  and  //\  C'  and  E\  and  D'  and  F1  are  equidistant 
from  the  origin.  So,  OmtxiSr)  is  given  by 

<W(ST)  =  max[d(0'A'),d(0‘ '  B'),d(0'd),d{0' D')].  (80) 

Using  (33)  and  the  well-known  “distance”  formula,  the  distance  d(OA ')  from  the  origin  O  to  the  point  A' 
is  given  by 

d(.OA  )  =  \/(aiin,  +ai2r5«  +aun.)z  +  (oun#  +  ann.  +aarJo)1  +(ann.  +  ann.)2.  (81) 

In  exactly  analogous  fashion,  we  obtain 

d{OB' )  =  \/(ann*  -  aun.  +  <»iin.)J  +  (a2in«  -  aar*  +  aon.)*  +  (ann.  -  aarj,  +aj3n»)2  (82) 

d(OC  )  =  yj(—aur\»  —  ♦  aur*,)*  +  (— aun»  -  flan*  +  aan.)2  +  (— ajirio  —  ann»  +  arsT-v,)2  (83) 


4(00)  *  \/(-aun«  +  <1120.  + an n,)1  +(-<32in.  +flan.)2  +  (-<Jjin.  +  032^2,  +aj3rs,)fl.  (84) 

Equations  (80),  (81),  (82),  (83)  and  (84)  comprise  Result  1. 

Proof  of  Result  2: 

The  isotropic  acceleration  of  Sr  is  the  shortest  distance  from  the  origin  to  the  sides  of  the  parallelopiped 
A'fi'c'D'E'F'GV.  Letting  p  (  A'b'f'e'  ),  p  (  D'c'G'//  ),  p  (  A'DH'e'  ),  p  (  B'C?G'F'  ),  p  (  a'b'c'd' 

)  and  p  (  EfF'G'H’  )  denote,  respectively,  the  distances  from  O  to  each  plane,  aijo(ST)  is  given  by 

auo(5r)  =  minr  o(A  fl  F  £  ),  p{f>  CG  H),  p(A  D  H  E' ),  p(BC‘GF),  p(ABCD),  p(EF  GH)}.  (85) 

Since  the  origin  is  the  centroid  of  the  parallelopiped  ST,  parallel  faces  of  the  parallelopiped  A' b'  Cf  DEf^GH1 
must  be  equidistant  from  the  origin.  Therefore,  we  can  write  the  following  relations: 


p(ab'f'e')  =  p(D'C,G'//), 
p(ad'h'e')  =  p(b'c'g'f'), 
p(a'b'c'd')  =  p(E'F'G'H'). 

Using  (86),  (87)  and  (88),  (85)  can  be  written  as 

aitoiSr)  =  min[p(A'B,F,E'),p(A'D'H'E'),p(A'B'c'D1)]. 
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The  distance  p  from  the  origin  to  a  plane  ax  +  by  +  cz  +  k-  0  in  the  xyz  -  space  is  given  by  the 
well-known  equation: 


Vat  +  b^  +  c? 

Using  equation  (90)  and  equations  (50),  (52)  and  (54),  we  obtain 


p(A  B  FE  ) 


_  I  detQ4)  I  rl0 

\J (fl22*rj3  -  0230Z2)1  +  (012^33  —  fll3032)2  +  (012^23  -  <*\%an)Z 


p(AD  HE) 
piABCD) 


I  detQ4)  1 

\Aa21tf33  -  fl23fl3i)2  +  (nn<*33  -  ouan)1  +  (aufl23  -  &nazi)2 
i  det (A)  |  n, 

V (<J2ia32  -  fljaflsi)2  +  (nufl32  -  flnnst)2  +  (<*11022  -  <*nai\)2 


(90) 


(91) 

(92) 

(93) 


Substituting  (91),  (92)  and  (93)  into  equation  (89),  we  can  obtain  the  required  result  (78)  fot  the  isotropic 
acceleration  fliro(5T). 


5.2  Properties  of  the  acceleration  set  Sq 

Since  each  element  of  the  set  Sq  represents  the  total  non-linearity,  we  characterize  the  set  Sq  by  the 
maximum  magnitude  element  which  denote  the  maximum  non-linearity.  Also,  we  calculate  the  maximum 
distances  from  direction  planes  in  subsection  4.1  to  measure  the  effects  of  the  non-linearity  on  the  state 
acceleration  set. 

Similar  to  a  two  degree-of-frcedora  manipulator,  we  illustrate  the  steps  to  the  analytical  expression  of 
the  furthest  point  of  set  Sq,  and  the  steps  to  the  analytical  expression  of  the  furthest  point  from  direction 
planes. 

Definition  1:  Let/-,  i  =  1,  2,  3  denote,  respectively,  the  following  cubic  functions  in  the  joint  variable 
rates  in,  i  =  1,  2,  3; 

/i($i>  ifi,  $j)  =  (&u$i  +  &i2$i  +  ^3^3  +  +  2/inifiifj  +  2nn()j$i  +  siXbwQi  +  «u<h  +  «i3$3) 

+  bnt&  +  £u43  +  +  2flj2$2$3  +  2/»23$3$l  ♦rj)(&31$l  +  «21$1  +  rt23$3) 

Hhitf  +  bnQ i  +  bnji  +  2/«3i<h<fr  +  2/*n<fr<fc  +  2/t33$3<)i  +*3X^31  +  *31^2  +^33^3)  *  0,  (94) 

/i(<?ii  <?2 1  4s)  =  (&ii$i  +  b\it&  +  frn'i's  +  2/»h$i$2  +  2nu^3^3  +  2nu$3<h  +  JiX^u^i  +  «n$2  +»i3$3) 

•Ktu4i  +  +  2nui}iifi  +  2«a^j^3  +  InnMi  +  *2X^21  $1  +  *21  $2  +  «r  $3) 

+(&3i<)i  +  bndi  +  ^>3343  ♦  2rt3i^i^i  +  2/tn$2<b  +  2/t33<fr<fr  +fiXfai4i  +  *3i$2  +'»33$3)  3  0  (95) 
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Equations 

Variables 

Notation  used  to  denote  solutions 

hifao,  fa,  fa)  =  0  and/jCft*,  fa,  fa)  =  0 

fa,  fa 

*0)  >0) 

<h  ,  ft 

/3(<7i,  <fao,  fa) -0  and /i  (ft,  fao,  fa)  =  0 

fa,  fa 

f\(fa,  fa,  fao)  -  o  and/2(qi,  fa,  faa)  =  0 

fa,  fa 

<g> 

Mfa,  fao,  fao)  -  o 

fa 

f\ (fa ,  ~<Jlo,  fao)  =  0 

fa 

*?> 

h(fao,  fa,  fao)  -  0 

fa 

flfao,  fa,  -fao)  =  0 

fa 

<p 

o 

1! 

Jj 

■'Sr 

$ 

fa 

fi((J\o,  -fao,  fa)  =  0 

fa 

Table  1:  Solutions  of  cubic  equations 


h  -  (bu4i  +  61243  +  2/in4i42  +  2«u4j4*  +  2 »»<M»  +  *iX&u4i  +  «u42  +  nu<h) 

■&u4i  +  6n4?  +  &u43  +2ny4i4s  +  Inuifiifj  +  irtnfaQi  +  52X^21  4i  +nu4i  +  nu^j) 

■Kbji4i  +  62242  +  63342  +  2/t3i4i4*  +  2«b4i43  ♦  2ah4j4i  ♦  ■rsXfcji4i  +  «h4j  +  «h4j)  =  0.  (96) 

where  fi(q\ ,  ft,  ft).  (i  =  1,  2,  3)  is  cubic  in  ft,  ft  and  fa. 

Definition  2:  It  is  useful  in  our  derivaions  to  be  able  to  refer  to  the  solutions  of  certain  equations  which 
play  an  important  role  in  obtaining  the  maximum  acceleration  of  S^,  OmtxC^).  Each  equation  or 
equation  pair  of  interest  is  given  in  column  1  and  the  corresponding  variables  are  indicated  in 

column  2.  AH  equations  in  column  I  are  cubics  in  the  variables  in  column  2.  The  notation  used  to 

denote  the  solution  of  each  equation  or  equation  pair  is  given  in  column  3. 

Definition  3: 

m  -  Ufa,  fa,  fa) 
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(97) 


(&U$1  +  &12$2  +  &13$!  +  2/»U$l<72  +  2ni2<?2(?3  +  2«i3<fr$i  +  Si)2 
+  (£21<?i  +  *12<?2  +  h23<jf  +  2^21  $1  <t2  +  2/t22$2  $3  +  2rt23$34l  +  Si)1 
^  +(i>31<fl +*32<^+^>33?3+27»3i$i<?2  +  2^32^2?3  +  2«33l?3<y[ +J3)2  y 


Definition  4:  Let  hi,  i  =  1,  2,  3  denote,  respectively,  the  following  linear  equations  in  the  joint  variable 
rates,  <7„  i  =  1,  2,  3; 


h\(q\,  <h,  qj) 


hj(q\ ,  <72,  <?3) 


(322*233  ~  fl23^32)(^n<7l  +  «U<?2  +  *13*73) 

+  (313332  -  tfl2£33)(f>21<7l  +  «21<?2  +  «23<?3) 
+  (012^23  ~  ai3a22)(&3i<?i  +  rt3l<?2  +  «33<?3) 

(<222<333  ~  tf23<232>(£i2<?l  +  »Il<72  +  «12^3> 

+  (*213332  ~  ^12a33)(&22?l  +  «21?2  +  «23?3) 
+  (312323  ~  22t3322)(£>32<7l  +  +  332<73> 


h-$(q\,  <?2,  fa) 


(322333  -  323332)(&13<7l  +  «12?2  +  >»13<73) 

+  (313332  -  3i2333)(&23*7l  +  «22<?2  +  «23<73) 

+  (312323  -  <2l3<222)(£33<?I  +  «32<?2  +  *33*73) 


where  hi(q\,  q 2,  <73).  (i  =  1,  2,  3)  is  linear  in  <j\,  fa  and  <73. 


(98) 


(99) 


(100) 


Definition  5:  It  is  also  useful  in  our  derivaions  to  be  able  to  refer  to  the  solutions  of  certain  equations 
which  play  an  important  role  in  obtaining  Om.,(x(Sq).p.).  i  =  2,  3,  defined  below.  In  table  2, 

each  equation  or  equation  pair  of  interest  is  given  in  column  1  and  the  corresponding  variables  arc 
indicated  in  column  2.  All  equations  in  column  1  are  linear  in  the  variables  in  column  2.  The 
notation  used  to  denote  the  solution  of  each  equation  or  equation  pair  is  given  in  column  3. 

Definition  6: 


<7|($1,  $1.  $>) 

*  [(<*22013  -  <*B0i2)i  +  (012033  —  012013)2  +  (<*12013  -  0i3022)2)-^ 

^  (022<*13  —  023<*b)2(1>ii4,i  +  bl2$2  ♦  b:3<7j  +  2*»ll<fl^2  +  +  2fli3$l$l  +  S])  \ 

(0120U  —  0i20w)2(6u4i  +  ♦  t*34i  ♦  2*»2i<)i<72  +  2**B<fr<73  +  2nolf)ii\  +  n>  j  (101) 

^  +  (0120J3  -  0130J2)2(^n4f  +  +  i>13<73  +  2/»3i^l^2  +  2*»32<72<73  2^33^l4l  +  Jl)  ) 

0l($l.  $2.  $l) 
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Equations 

Variables 

Notation  used  to  denote  solutions 

hiiqio,  <h,  ifi)  =  0  and  ft(fta,  in,  ft)  =  0 

ft,  ft 

tf1 

ft(ft,  ft*,  ft)  =  0  and  Ai(ft,  ft*,  ft)  =  0 

ft,  ft 

#.  tf1 

Ai(ft,  ft,  ft*)  =  0  and  A2(ft,  ft,  ft«)  =  0 

ft,  ft 

$] 

Ai(ft,  ft«,  fto)  =  o 

ft 

Ai(ft,  -ft fto)  =  0 

ft 

M5' 

A2(ft<>,  ft,  fto)  =  0 

ft 

# 

A2(ft<>,  ft,  -ft<,)  =  0 

ill 

A3(fto,  ft,,  ft)  =  o 

ft 

*Cs- 

oo 

ft(fto,  -fto,  ft)  =  0 

ft 

J9| 

ft 

Table  2:  Solutions  of  linear  equations 


*  [(azjdji  —  'v.  an?  +  (anasi  —  onajjf  +  (021013  —  anau)2]-^ 

^  (oiiajj  —  anaji)2(butf  +  bufi  *  bi3#j  *  2/i.i$i$i  +  InuQifa  +  InnifaQi  +  Ji)  ^ 
+  (ajiflu  —  auaj3)2(bu^i  +  bn<&  +  +  2/»n<ti$2  +  2/tn<fc<fa  +  2/»n<fr4i  +  ft) 

^  +  (fluajj  —  flnaji)2(6ji^i +frn<)2 +  djj43  +  2n3i^i^i  +  2nj2^i^3  +  2n3j^j^i +jj)  / 

aj($i,  <h,  4s) 

=  (anau  —  aaasi)1  +  (a»a32  —  fluau)2  +  (auaa  —  auau)2]-! 

^  (ai2aii  —  as2aji)2(feu4f  +  +  2/iu$i^4  +  2/«u^2^3  +  2nn^3^i  +  Ji)  ^ 

+  (aji^u  —  auan)2(b3i^j  +  bn^A  +  ba<)i  +  2nuQ\fa  +  +  Inufrth  +  ft) 

^  +(anaa  —  aiiaii)2(b3i4,i +i>32<ji +i>33^3 +2«3i<?i<?2 +2ni2^2<?3 +2^33^3^! +ft)  ) 


(102) 


(103) 


Definition  7:  Let  p(x(Sq),pi),  p(x(Sq),p2)  and  p(x(Sq),p3>  denote,  respectively,  the  distance  of  any  point 
x(Sq)  of  Sq  from  the  planes  p\,  p2  and  /?3. 


PmK(x(5q),Pl)  =  max  p(x(Sq),pi), 

(104) 

Pm«(x(5q),p2)  =  maxpOtfSq)^), 

(105) 

Pm«(x(Sq),p3)  =  maxp(*(Sq),p3). 

(106) 

Pm»x(*(Sq),pi),  for  example,  represents  the  distance  of  that  point  of  Sq  furthest  from  plane  p\\ 
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Atux(x(S<j),/>i),  /w(*(5q),P2>  and  Pm»x(x(Sq),p3)  are  necessary  for  determining  the  local  isotropic 
acceleration  in  subsection  5.4. 


Result  1:  For  a  general  three  degree-of-freedom  spatial  manipulator,  the  maximum  acceleration  of  the 
acceleration  set  Sq  will  be  denoted  by  Onm(Sq)  and  is  given  by 

=  max[/(i),  l(i),  ...,  (107) 

where 


An 

= 

Kqio,  »  <73 

h) 

= 

Kqf,  <ho ,  <7?) 

h) 

= 

l(<7(t3),  <fr*) 

1(4) 

= 

l(?j4),  <fco,  <73 o) 

1(5) 

s 

1(?1  \  ~Qlo,  <tio) 

1(6) 

= 

Kqio,  qf,  fro) 

1(7) 

s 

Kqio,  -qio) 

1(8) 

= 

Kqio,  qio,  q?) 

1(9) 

= 

Kqio ,  ~qio,  ?39)) 

1(10) 

s 

l(<7lo,  $3«) 

1(11) 

s 

Kqio,  qzo,  -qio) 

1(12) 

= 

Kqio,  -q2o,  -foo) 

1(13) 

= 

Kqio,  -ifi*,  q-io) 

Result  2:  For  a  general  three  degree-of-freedom  manipulator,  the  maximum  distance  from  an  element  of 
Sq  to  the  reference  planes  pi,  P2  and  pi  are,  respectively,  given  by 

(108) 
(109) 


max[p(x(Sq),p,)],i  =1,2,3 
=  max[(<7|)(l),  (<7,)(2),  ■  .  •  ,  (<7i)(I3)] 


36 


where 


s 

<n(fao,  4U>  411) 

fo)[2] 

= 

<ti(<i i21,  Q2o,  #) 

(^i)[3] 

= 

<t,(q[x],  431’  fa°) 

(<^*)[41 

= 

<ti(q\4],  ifao,  fa 0) 

(<7i)[5] 

= 

<ti(,q[x  \  -fa 0,  fa 0) 

(<7*)[6] 

= 

(tiifao,  $],  fa 0) 

(o'Opi 

= 

<?i(fao,  ,  —fa o) 

(^ilis] 

= 

Oiifao,  fao,  4®1) 

(ft  *)[91 

= 

Viifao,  —fao,  491) 

(<7i)ll0] 

= 

(TiCfao,  fao,  fao) 

(<7i)[ll) 

s 

0i(fao,  fao ,  -fao) 

(<ti)[  121 

= 

Oi(q\o,  ~ij2o,  -fao) 

= 

<?i(qio,  -qzo,  fa 0) 

where  fa,  fa)  (i  =  1,  2,  3)  are  defined  by  equations  (101),  (102)  and  (103). 

Proof  of  Result  1: 

The  magnitude  squared  of  the  acceleration  of  a  point  x(5'q)  of  Sq  denoted  by  a2(oq)  is  given  by 

ctiSq)  =  l\q\,  fa,  fa)  =  *i(q\,  fa,fa)  +  *i(qi,  fa,  fa)  +  $(qi,  fa,  fa) 

»  (&n<?i  +  *12^2  +  +  2nufafa  +  Innfafa  +  2n\3fafa  +  Si)2 

+  (faltf  +fa2$  +1*2303  +  2*21  fa  fa  +  ^2ifafa  +2n23fafa  +  Slf 

+  (&ji$i  +  fai^2*fai^3  +  2^31^1  fa  +  2ri3zqifa  +2n33faq\  +i3)2  (110) 


The  maximum  magnitude  squared  of  the  acceleration  for  the  set  Sq,  denoted  by  <zjLx(Sq).  *s  given  by 
<4«(Sq)  =  max/2(<7i,  fa,  fa),  (HI) 
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where  F  is  shown  in  Figure  2  and  is  specified  by  the  constraints 


91 

l<  9i<m 

(112) 

<n 

l<  92 a- 

(113) 

93 

!<  93*- 

014) 

The  maximum  of  (110)  will  occur  at  q  €  F  which  is  either  inside  F  or  on  the  boundaries  of  F 
where  one,  two  or  three  constraints  might  be  active.  In  section  5.1.2,  we  showed  that  “opposite"  pairs  of 
bounding  planes  have  the  same  set;  Using  very  similar  arguments  to  those  used  to  demonstrate  the  result, 
we  can  show  that 

1.  The  following  pairs  of  bounding  edges  of  F, 


(K2L2), 

(KxLx) 

(JjM2\ 

(■ft  Mi) 

C L2M2 ), 

C l\Mx ) 

C/i*i), 

(J2K2) 

(AL2), 

(J2L1) 

(K2Mx) 

have  the  same  image  set 

2.  The  following  pairs  of  vertices  of  F 


L2, 

Lx 

Ju 

h 

Ku 

k2 

m2, 

M\ 

have  the  same  image. 

Therefore,  tc  obtain  the  maximum  of  (110)  under  the  constraints  (112),  (113)  and  (114),  we  should 
consider  the  following  possibilities: 
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1.  Neither  of  the  constraints  is  active,  i.e.,  the  max[P(,qi,  42,  93)]  occurs  at  a  point  4  inside  F. 

2.  One  of  the  constraints  (112),  (113)  and  (114)  is  active,  i.e.,  Tnax[P(qi ,  42,  43)]  occurs  at  a  point  q 

lying  on  the  plane  J\K\M2bi  or  or  L2M2J2K2  of  F. 

3.  Two  of  the  constraints  (112),  (113)  and  (114)  are  active,  i.e.,  max[/2(4i,  $3)]  occurs  at  a  point 

q  lying  on  the  edge  KjLz,  J2M2,  L2M2,  J\K\,  J\Li  and  K\M2  of  F. 

4.  All  of  the  constraints  are  active,  i.e.,  max[/2(^i,  q 2)]  occurs  at  vertex  L2,  vertex  J\,  vertex  K 1,  or 
vertex  M2. 

To  obtain  the  conditions  for  each  one  of  the  above  cases  to  yield  a  maximum,  we  first  differentiate 
f2(4i,42,  <73)  with  respect  to  4t.  -ft  and  <73  to  obtain 

=  4/i (qu  <72,  43)  (115) 

=  4/2(<7i,  q2,  43)  (116) 

=  4/3(4l,  42,  4s)  (117) 

where  /(4i,  42,  43).  (i  =  1,  2,  3),  were  defined  in  (94),  (95)  and  (96). 

Now,  we  consider  each  case. 

Case  1 

To  obtain  the  maximum  of  l  for  the  case  where  all  of  the  constraints  are  inactive,  we  set  the  right-hand 
side  of  (115),  (116)  and  (117)  to  zero.  This  gives  us  the  equations 

Mu  42,  43)  =  0,  (i  =  1,  2,  3)  (118) 

and  the  solution 

41  =42  =  43  *0  (119) 

of  which  actually  corresponds  to  the  minimum  value  of  £(41,  42  ,  43),  v'z-  zero.  Therefore,  max(/2)  does 
not  occur  at  a  point  q  inside  F  which  is  to  be  expected. 

Case  2 


dl2 
dqx 
dl2 
dq2 
dl 2 
dq3 
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Consider  the  case  in  which  one  of  the  constraints  (112),  (113)  and  (114)  is  active.  When  constraint 
(112)  is  active  on  the  plane  of  the  F,  we  have 

<7i  *  q\0  (constant).  (12 0) 

To  obtain  the  maximum  of  I2,  we  set  both  dP/dqz  =  0  and  dl2/dift  =  0.  We  therefore  set  the 
right-hand  sides  of  both  (116)  and  (117)  to  zero  to  obtain  the  following  cubic  equations: 

h  (  Qio,  fa,  fa)  =  0,  (121) 

fi  (  fa O,  in,  in)  =  0-  (122) 

| <72 1  <  ifio,  | <73 1  <  Hi0  whose  real  solution,  if  it  exists,  is  denoted  by  q^  and  q$\ 

Therefore,  max/(<7i,  <72,  in)  ibis  case  is  given 

max[/(^i,  in,  <?3)]  *  K<iu>,  q{2,  ifi\  (123) 

Comment: 

Using  simple  arguments  from  algebraic  geometry  (Semple  and  Roth,  1949),  we  can  show  that  if  the 
cubics  (121)  and  (122)  with  constraints  |fo|  <  ino  and  |&|  <  foo  have  real  points  of  intersection,  then 
they  can  at  most  one  real  point  of  intersection.  If  Hill,  in,  in)  does  have  a  maximum  An».  then  the 
conditions  dl2/dqz  =  0  and  di2/dqz  =  0  for  obtaining  P**,  and  therefore  the  pair  of  equations  (121)  and 
(122)  which  follow  from  them,  are  essentially  conditions  for  the  quadratic  surface  which  is  the  image,  in 
the  x-space,  of  the  plane  J\K\MzLz  to  have  a  common  tangent  plane  with  a  sphere  of  radius  l(q\,  <72,  <73). 
A  sphere  and  a  quadratic  can  have  at  most  two  points  of  tangency.  Therefore,  the  simultaneous  solutions 
of  (121)  and  (122)  can  have  at  most  two  real  roots.  However,  since  (121)  and  (122)  are  equations  of 
cubic  curves,  they  will  have,  in  general,  nine  points  of  intersection.  If  equations  (121)  and  (122)  had  only 
two  real  roots  in  common,  the  remaining  seven  common  roots  would  have  to  be  imaginary,  which  is  not 
possible.  Therefore,  (121)  and  (122)  will  have  exactly  one  root,  if  we  do  not  impose  any  constraints  on 
<72  and  <73.  In  the  case  where  <72  and  <73  are  constrained  the  real  root  might  lie  outside  the  region  specified 
by  the  constraints. 

In  an  analogous  fashion,  we  obtain  the  following  maximum  for  /  when  constraint  (113)  is  on  plane 
J\LzKiM\\ 

max[/(<7i,  in,  in)]  =  K<ff\  ho,  ij?\  (l24) 
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where  qf\  qf^  is  the  real  solution  of  the  following  two  cubic  equations, 

f\  (  <7i,  qio,  <73)  =  0,  (125) 

fi  (  <7t,  qzo,  4i) =  0.  (126) 

We  also  can  obtain  the  following  maximum  for  /  when  constraint  (114)  is  active  on  plane  L2M.2J2K.2-. 

max(/(<7i,  <73)3  =  l(qf\  q$\  qio).  (127) 

where  q^,  q^  is  the  real  solution  of  the  following  two  cubic  equations, 

/1  (  4\,  42,  q3o)~  0,  (128) 

h  (  4i,  42,  (129) 


Case  3 

Consider  the  case  in  which  two  of  the  constraints  (112),  (113)  and  (114)  are  active.  When  constraints 
(113)  and  (114)  arc  active  on  the  edge  JC2L2  of  F,  we  have  the  followig  conditions, 

q2-<l2o  (constant),  (130) 

<73  =  <73o  (constant).  (131) 

To  obtain  the  maximum,  we  set  dfl/dq\  =  0.  We  therefore  set  the  right-hand  side  of  (115)  to  zero 
and  set  qz  -  4io  and  <73  =  q^o  to  obtain  the  cubic: 

/t(<7t»  42o,  43o)  =  0.  |$i|  <  4\0  (132) 

Using  arguments  similar  to  those  used  above,  we  can  show  that  (132)  can  have  at  most  one  real  solution 
which  we  denote  by  The  corresponding  value  of  /  is  as  follows: 

max[/(<7i,  ifz ,  qi)]  =  l(q{*\  qzo,  43o)-  (133) 

In  an  analogous  fashion,  we  can  obtain  the  following  maximum  for  /  when  constraints  (113)  and  (114) 
are  active  on  edge  J2M2'. 

maxNOji,  4z ,  fc)]  =  /(qf\  - qzo ,  &*)•  (134) 
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where  <7^  is  the  real  solution  of  the  following  cubic  equation, 

A  (to,  -too.  too)  =  0;  (135) 

For  the  case  when  constraints  (112)  and  (114)  are  active  on  edge  L2M1,  we  obtain 

max[/(to,  to.  to)]  = /(too,  46).  to*).  (136) 

where  ^  is  the  solution  of  the  following  cubic  equation: 

h  (  too.  to.  too)  =  0.  (137) 

For  the  case  when  constraints  (112)  and  (114)  are  active  on  edge  J\K\,  we  obtain 

max[/(to,  to.  to)l  =  ((too.  ^2>.  -too).  (138) 

where  ifp  is  the  real  solution  of  the  following  cubic  equation: 

A  (  to.  to,  -too)  *  0-  (139) 

For  the  case  when  constraints  (112)  and  (113)  are  active  on  edge  J\Li,  we  obtain 

max(/(to.  to,  to)l  = /(too,  <72o,  <?38)),  d40) 

where  qP  is  the  real  solution  of  the  following  cubic  equation, 

A  (  too,  too,  to)  =  0.  (141) 

For  the  case  when  constraints  (112)  and  (113)  on  edge  K\Mz,  we  obtain 

max[7(to,  to,  to)]  = /(too,  -too,  ^9)),  042) 

where  <7^  is  the  real  solution  of  the  following  cubic  equation: 

A  (  too,  -too,  to)  =  0-  (I43) 


Case  4 
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Consider  the  case  in  which  all  of  the  constraints  (115),  (116)  and  (117)  are  active.  When  all  three 
constraints  are  active,  and  if  max[/2(to,  to,  to)]  occurs  at  L2(too,  qio,  too).  then 


max[/(to,  to,  to)]  =  ((too,  too,  too)-  (144) 

If  the  maximum  of  /2  occurs  at  J\(q\0,  <ho,  -too),  then 

max[/(to,  to.  to)]  =  ((too,  too,  -too)-  (145) 

If  the  maximum  of  l 2  occurs  at  K\(q\0,  -(ho,  -too),  then 

max[/(to,  to.  to)l  =  Ktoo,  —too,  -too)-  (146) 

If  the  maximum  of  Z2  occurs  at  A/2(too.  'too.  too),  then 

max[/(to,  to,  to)]  =  ((too,  -too,  too)-  (147) 


Therefore,  OmuCSq)  (=  max[l(to,  to.  to)])  is  obtained  as  the  maximum  of  thirteen  quantities  defined 
by  equations  (123),  (124)  (127),  (133),  (134),  (136),  (138),  (140),  (142),  (144),  (145),  (146)  and  (147). 
Thus  we  have  demonstrated  Result  1. 

Proof  of  Result  2: 

The  distance  of  any  point  x(Sq)  of  Sq  from  the  line  p,-,  i=l,  2,  3,  is  given  by 

pfxtfqXpi)  =  (Ti(qi,  to,  to)  (148) 

p(x(Sq),p2)  =  <r2(to,  to,  to)  (149) 

P(x(Sq),P3)  =  <73(to>  to,  to)-  (150) 

We  first  wish  to  determine  Pm«x(x(Sq).Pi)  the  distance  of  p\  from  that  point  of  Sq  furthest  away  from  it 
(Pi)- 

Pm«(x(5q),pi)=  max<7i(to,  to,  to)  (151) 

H  (q€F) 
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where  F  is  shown  in  Figure  2  and  is  specified  by  the  constraints 


(152) 

(153) 

(154) 


I  |< 

I  (fz  |<  <72*. 

I  <73  |<  <73 *• 

The  maximum  of  (101)  which  is  required  in  (151)  will  occur  at  point  q  €  F  which  is  either  inside  F  or 
on  the  boundaries  of  F  where  one  or  two  or  three  constraints  might  be  active.  Using  the  same  arguments 
as  in  Result  1  above,  to  obtain  the  maximum  of  (101)  under  the  constraints  (152),  (153)  and  (154),  we 
should  consider  the  following  possibilities: 

a 

1.  Neither  of  the  constraints  is  active,  i.e.,  the  max[<ri(^i,  ^2, 473)1  occurs  at  a  point  q  inside  F. 

2.  One  of  the  constraints  (152),  (153)  and  (154)  is  active,  i.e.,  max[<ri(<7i,  qi,  <73)]  occurs  at  a  point 
q  lying  on  the  plane  J1K1M2L4  or  plane  J\biKiM\  or  plane  L2M2J2K2  of  F. 

3.  Two  of  the  constraints  (152),  (153)  and  (154)  arc  active,  i.e.,  maxfo-i (<71,  <72,  <73)]  occurs  at  a  point 
q  lying  on  the  edges  K2L2,  J2M2,  L2M2,  J\K\,  J\Li  and  K\M2  of  F. 

4.  All  of  the  constraints  are  active,  i.e.,  max(<rj(qi,  <fc,  <73)]  occurs  at  a  point  q  lying  on  the  vertex 
Z-2.  vertex  J\,  vertex  K\  or  vertex  A/2-1 


To  obtain  the  conditions  for  each  one  of  the  above  cases  to  yield  a  maximum,  we  first  differentiate 
<73)  with  respect  to  q\,  ifi  and  $3  to  obtain 


do\  h\ 

d<7i  ~  z 

da\  h2 

dqi  “  z 

d(T\  _  A3 

d<73  ~  z 


(155) 

(156) 

(157) 


where  hi,  (i  =  1,2,  3),  have  been  defined  in  (98),  (99)  and  (100)  and 


z  =  V  (<322*333  -  <223 032)2  +  (<*12033  ~  032<*13)2  +  (<*12<*23  -  Ol3<*22)2  (158) 

‘Since,  by  virtue  of  Fact  3  of  subsection  3.1.2,  the  vertices  J\  and  J\  have  the  same  image,  we  only  need  to  consider  either 
J]  or  h\  we  will  choose  J\.  So  are  the  vertices  K\  and  Ki  and  vertices  Mi  and  Mi. 
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Now,  we  consider  each  case. 


Case  1 

To  obtain  the  maximum  of  p\  for  the  case  where  all  of  the  constraints  are  inactive,  we  set  the  right-hand 
side  of  (155),  (156)  and  (157)  to  zero.  This  gives  us  the  equations 

hi(q\,  fa,  $3)  =  0,0  =  1,  2,  3), 

and  the  solution 

fa  -  fa  =  <73  =  0  (159) 

of  which  actually  corresponds  to  the  minimum  value  of  pi(fa,  fa,  <73),  viz,  zero.  Therefore,  max(pi) 
does  not  occur  at  a  point  q  inside  F. 

Case  2 

Consider  the  case  in  which  one  of  the  constraints  (152),  (153)  and  (154)  is  active.  When  constraint 
(152)  is  active  on  the  plane  J\K\M2bi  of  F,  we  have 

fa  -  fao  (constant).  (160) 

To  obtain  the  maximum  of  p\,  we  set  both  dp\/dfa  =  0  and  dp\/dfa  =  0.  We  therefore  set  the 
right-hand  side  of  both  (156)  and  (157)  to  zero  to  obtain  the  following  two  linear  equations, 

h.  (  fao,  fa,  fa)  =  0,  (161) 

*3  (  fao,  fa,  fa)  =  0.  (162) 

\fa\  <  fao,  tol  <  fao- 

Denoting  the  solution  fa  and  fa  of  (161)  and  (162)  by  c$K  q^\  the  maximum  of  /  for  this  case  is  given 
by 

max[pi(<7i,  fa,  fa)]  =  pi(fao,  <$],  (163) 

In  an  analogous  fashion,  we  can  obtain  the  following  maximum  for  p\  when  constraint  (153)  is  active  on 
plane  JxLiK-JA  1 : 

max[pt(<7i,  fa,  fa)}  =  pi(^21,  fao,  421),  (164) 
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where  is  the  solution  of  the  following  two  linear  equations, 

h\  (  7l»  72*,  73)  =  0,  (165) 

h  (  «7i ,  72*,  73)  =  0.  (166) 

We  also  can  obtain  the  following  maximum  for  p\  when  constraint  (154)  is  active  on  plane  L2M2J2K2' 
max[pi(<7i,  <73)]  =  Pi(ql\  \  431*  <?3o).  (167) 

where  <j^3'  is  the  solution  of  the  following  two  linear  equations, 

At  (  7l,  72,  73*)  =  0,  (168) 

*2  (  7t>  72 ,  73*)  =  0-  (169) 

Case  3 

Consider  the  case  in  which  two  of  the  constraints  (152),  (153)  and  (154)  are  active.  When  constraints 

(153)  and  (154)  are  active  on  the  edge  K2L2  of  F,  we  have  the  following  conditions, 

72  =  72*  (constant),  (170) 

<73  -  <73*  (constant).  (171) 

To  obtain  the  maximum,  we  set  dl2/dq\  =  0.  We  therefore  set  the  right-hand  side  of  (155)  to  zero 
and  set  72  ®  <72*  and  <73  =  <730  to  obtain 

*t(7t,  <72*.  73*)  =  0,  |<7i|  <  q\0.  (172) 

From  equation  (172),  we  obtain  the  solution  which  is  denoted  by  q j4J.  The  corresponding  value  of  pi  is 
as  follows: 

max[pi(<7i,  72,  <73)3  =  pi (ql?],  <72*,  <73*)-  (173) 

In  an  analogous  fashion,  we  can  obtain  the  following  maximum  for  p\  when  constraints  (153)  and 

(154)  are  active  on  edge  J2M2 

max[pi(7i,  <72,  73)3  =  PxitfK  -72*,  73*)-  (174) 
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where  <7 ^  is  the  solution  of  the  following  linear  equation, 

At  (  <7i,  -<l2o,  ho)  =  0;  (175) 

For  the  case  when  constraints  (152)  and  (154)  are  active  on  edge  L2M2,  we  obtain 

max[pi(<7i,  q2,  h)]  =  P\(ho,  q^ .  <73 «),  (176) 

where  <7^  is  the  solution  of  the  following  linear  equation, 

h  (  q\o ,  h,  ho)  =  0.  (177) 

* 

For  the  case  when  constraints  (152)  and  (154)  are  active  on  edge  J\K\,  we  obtain 

max(pi(<7i,  <72,  qi)\  =  P\(q\o,  -ho),  (178) 

where  is  the  solution  of  the  following  linear  equation: 

h  (  q\o,  h,  -ho)-  0.  (179) 

For  the  case  when  constraints  (152)  and  (153)  are  active  on  edge  J\Li ,  we  obtain 

max[pi(<7i,  <72,  <73)]  =  Piiho,  ho,  <ff]),  (180) 

where  <7381  is  the  solution  of  the  following  linear  equation, 

h  (  <7io,  ho,  h)  =  0.  (181) 

For  the  case  when  constraints  (152)  and  (153)  on  edge  K1M2,  we  obtain 

max(pt($i,  h,  <73)1  =  PtWio,  -ho,  $]),  (182) 

where  ^jj9*  is  the  solution  of  the  following  linear  equation: 

h  (  q\o,  - <ho ,  h)  =  0-  (183) 


Case  4 


47 


Consider  the  case  in  which  all  of  the  constraints  (152),  (15^)  and  (154)  are  active.  When  all  three 


constraints  are  active,  and  if  max[pi(ft,  ft,  <73)]  occurs  at  Li(qy0,  qio,  <73o).  then 


max[pi(^i,  <n))  =  p\(q\o,  <ho,  fto).  (184) 

If  the  maximum  of  p\  occurs  at  J\(q\0>  <tio>  -ft0),  then 

max[pi(<7i,  ft,  ft)]  =  Pi(<7lo,  fto,  -fto),  (185) 

If  the  maximum  of  p\  occurs  at  K\(q\0,  -fto,  -ft0),  then 

max[pi(ft,  ft,  ft)]  =  Pt(<7to,  -<?2o,  -<73o),  (186) 

If  the  maximum  of  p\  occurs  at  Mi(q\0,  -qjo,  ifto ),  then 

max[pi(ft,  ft,  ft)]  =  Pi(fta,  -qio,  fo o)-  (187) 


Therefore,  pmut(*(Sq),  Pi)  is  obtained  as  the  maximum  of  thirteen  quantities  defined  by  equations 
(163),  (164)  (167),  (173),  (174),  (176),  (178),  (180),  (182),  (184),  (185),  (186)  and  (187).  In  exactly, 
analogous  fashion,  pm«x(x(Sq),ft)  and  pnu*(jt(Sq),p3)  arc  obtained  as  in  (109).  thus  we  have  demonstrated 
Result  2. 


S3  Properties  of  the  state  acceleration  set 
Definition: 

K  :  centroid  of  the  acceleration  set  in  the  x-space  with  coordinates  k\ ,  ki  and  £3  given  by  (40). 

p(K,  p\)  :  distance  from  point  K  to  the  reference  plane  p\. 

p(K,  P2)  •  distance  from  point  K  to  the  reference  plane  pj. 

p(K,  pi)  :  distance  from  point  K  to  the  reference  plane  £>3. 


p(A  B  F  E  ),  p(A  "b"f"E"),  ...  :  distance  from  the  origin  to  plane  A  B  F  E  ,  A  B  F'  E' 
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Result  1:  The  maximum  acceleration  corresponding  to  any  dynamic  state  u  of  the  manipulator  is  denoted 
by  <w(Su)  and  is  given  by 


<J=»(Su)  =  max[d(OA  ),  d(OB  ),  d{OC  ),  d{OD  ),d(OE  ),  d(OF  ),  d(OG  ),  d(OH  )] 


where 


dlpA  )  =  \J(a\\T\0  +  ayiru  +  aun®  +  ktf  +  (nan.  +  aan.  +  023  n«  +  fa)2  «■  (031+1®  +  0321%  +  033+3.  +  ij)2 

)  *  \/(0iin»  -  012+5®  +  013+3®  +  *i)2  +(auT3,  -  anru  +  au+3®  +  ki¥  +  (03m.  -  032+2.  + 033+3.  +  h)2 

d{OC  )  =  +  <Jun»  -  013+3®  -  *i)*  +  (021+1.  +  022+3®  —  023 no  —  *2)*  +  (031+3®  +  032+2®  —  033+3.  -  fc)2 

i(0£>  )  =  y/ (0n n*  —  012+2®  —  013+3®  —  Ai)1  +  (021+1.  —  022+2®  -  023+3®  —  *2)*  +  (031+1.  —  032+2.  —  033+3®  -  *3)* 

4(t?£  )  =  \/ (0U+1®  +  012 +2®  —  013 +3®  +  * l)2  +  (021+1®  +  022 T2e  —  023+3®  +  ^2 12  +  (031  A®  +  032+2®  “  033+3.  +  ^3 12 

d{OF  )  =  yj (anA®  —  012+2®  —  013+3®  +  fcl)2  +  (021+1®  —  022+2®  —  023+3.  +  klP  +  (031+2®  —  032+2®  —  033+3®  +  ^s)2 

<i(OG  )  =  y/(anf\*  +  012+2®  +  0i3 n®  —  *1 12  +  (oil n®  +  022+2®  +  a23+3®  —  fe)2  +  (031+1®  +  032+2.  +  033+2®  —  to)2 
4(0H  )  =  \/(a\ir\t  —  012+2®  +  013+3.  —  to)2  +  (021+1.  —  022*2®  +  023+3®  —  to)2  +  (ajjri®  —  032+2®  +  033+3®  —  to)2 

Result  2:  The  necessary  and  sufficient  conditions  for  the  existence  of  the  isotropic  acceleration  are  the 
following: 

|  dCt(A)|n.  -  1(022033  -  0230n)*l +(013032  -  0U033)^2 +  (012023  -  022013)^31  >  o,  (189) 

|  det(A)|fl»  —  1(021033  —  023031  )*1  +  (011033  —  013031  )to  +(011023  —  02l013)to|  >  0-  (190) 

I  det(A)|ri,  —  |(021032  —  02203l)to  +  (012031  —  011032)^2  +(011022  —  01202l)to|  >  0.  (191) 


Result  3:  The  isotropic  acceleration  corresponding  to  any  dynamic  state  u  of  the  manipulator  is  denoted 
by  <2jJO(Sii)  and  is  given  by 

ldet(iA)lr),|-J(aa|a31^023^3l)|*l*(013032-|a[12°33)|*7|^(flll|023|-022013)*3l^ 
y/  (022031  -<223031  >*+(013032-012  «33  )*+(<l  12«23 -022013)1 

mjn  |det(A)|T2®-|(aaaii  -021 033)*!  ■*•(011033 -013031  )to+(an023 -an  anltol  ^  (192) 

y/  (023031  -<*21  ®33)2+(0110»-01303i?+(011a23  -021013)2 
|det(/t)|rv-|(a;ian-a2203l)*l+(ai:03i  -ana33)to-Kaiia22-ai202l'>tol 
.  3/(012032-022031  )2+(ai2«31  -011032)2+(01ia22 -012021 12 


Proof  of  result  1: 

Let  d(OA ")  through  d(OH ”)  denote,  respectively,  the  distances  of  vertices  A"  through  H"  from  the 
origin  O  in  the  x-space.  Then  amM(Su)  is  the  distances  of  the  furthest  vertex  of  the  set  5U  which  is  the 
parallelopiped  A" B'' C" O'' E" F" G" H" .  Therefore,  am«x(5u)  is  given  by 

0bm(£u)  =  max[d(OA  ),  d(OB''),  d(OC"),  d(OD"),  d(OE  ),  d(OF"),  d{OG  ),  d(OH" )].  (193) 
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Using  (49),  the  coordinates  xi(A xi(A")  and  x$ {A")  of  vertex  A"  in  the  x-space  are  given  by 


x i(A' )  =  *i(A  )  +  *i  =auTi0  +  ai2r2a  +  ai3T2O  +  ku  (194) 

*264")  =  *2(A)  +  k2  =  (*z\Ti0  + O22T20  + OxTio  +  ki,  (195) 

*304  )  =  X3(A  )  +  *3  =  fl3ino  +  azirio  +  <233^30  +  h.  (196) 

The  distance  d(OA ")  from  the  origin  O  to  the  point  A"  is  given  by 

<t(0  A  )  =  (197) 

In  exactly  analogous  fashion,  we  obtain 


<r(0  B  ) 


n (an t\0  —  a\2^i0  +  Oi3Tw  +  ^1  J2  +  (021  n*  —  on^u  +  +  fe)2  +  (031  ru  -  <*32*^0  +  ^33^#  +  ^j)*(W8) 


<7(0  C  )  =  +312^#  —  flurw  —  *l)*  +  (dun#  +  <*22 —  <*23r*o  —  fe)2  +  (<*31  T\0  +  <*32^2*  —  <*33 ri*  —  ^3p9°) 

<r(0  D  )  =  \/ (aun»  —  aun.  —  ann.  -  Jkt)2  +  (<m  n»  -  aan»  ~  flan.  -  fa)2  +  (an  n#  —  aim.  -  Ann.  -  <200) 


<r(0  £  ) 


^(ann*  +  aun.  -  aurs.  +  41)1  +(<Jiin.  + aan.  -  an  TV  +  fa)2  +  (fljm.  +  flan.  -  a^n*  +  fa)*(201) 


<r(0  F  )  =  \/(ann«  —  flun.  —  dun,  +  fa)2  +  (nun,  —  asn>  —  flan.  +  fa)2  +  (a» n.  —  flan.  —  ann,  +  fa (502) 

<y(0  G  )  =  \/(aun»  +flian.  +fluTv  —  fa)1  +  (flan»  +  a»n»  +  aarw  —  fa)2  +(<*31  n»  +  aj2n.  +  a»n.  —  fa)2 (203) 

a(0  //  )  «  \/ (anno  —  aun.  +  «i3rw  —  fa)1  +  (flan,  —  flan#  +  aan#  —  fa)2  +  (ajin#  —  a  32  TV  +  an  tv  —  fa  1504) 

Equations  (193)  and  (197)  through  (204)  comprises  Result  1. 


Proof  of  result  2  and  3: 

The  state  acceleration  set  ST  is  the  parallelopiped  centered  at  k(u)  =  (*1,^2, *3).  shown  in  Figure  8. 
The  centroids  of  ST  and  5U  are,  respectively,  by  O  and  K. 

Using  equations  (90),  (72)  and  (56)  through  (58),  the  distance  from  K  to  the  planes  p\,  pi  and  pj,  are 
given  by 

P(K  P\)  »  1  (a22g 33  ~  <fa3<*32)*l  +(^'3^32  ~  8l2fl33)*2  +  (<T  12^23  ~  ^22^13)^3  i  ^05) 

v/(a22fl31  —  «23<*3l)2  +  {OXiOil  ~  812833)2  +  (<*12033  ~  <*22<1  lj)2 
P(^  Pi)  M  I  (fl2lQ33  ~  023^31)^1  +  (811833  ~  8l383l)*2  +  (811823  ~  82lfll3)*3  I  ^06) 

V(<*23331  —  fl21«33)2  +  (011^33  ~  flUflJl)2  +  (811823  ~  <falfll3)2 
P(^  P3)  ~  I  (a21<*32  ~  822831)*!  +(012031  ~  Qlla32)*2  +  (811822  ~  8i282i)*3  I  ^07) 

\Z(fll2fl32  -  022P3l)2  +  (812831  ~  OUP32)2 +  (flllP22  ~  Pl2a2l)2 

The  distance  p(K,  p\)  from  the  centroid  K  of  Su  to  the  plane  p\  is  equal  to  the  perpendicular  distance 
between  plane  A  B'f'E?  and  plane  a"b"f" and  also  between  the  plane  D  C1  G  H"  and  plane  D  d  G  H1 . 


p(*\  pi) 


p(K,Pi) 


The  distance  p(K,  pi)  is  equal  to  the  perpendicular  distance  between  plane  A'd'h'e'  and  plane  a"d"H"e" 
and  also  between  plane  B'd G  F'  and  plane  B  'C"G"f"  .  The  distance  p{K,pi)  is  equal  to  the  perpendicular 
distance  between  plane  E?F'g'h'  and  plane  E"F"G"H" . 

The  state  isotropic  acceleration  <Zjso(£u)  is  the  maximum  acceleration  which  is  available  in  all  direc¬ 
tions.  It  is  therefore  equal  to  the  minimum  of  the  distances  from  the  origin  O  (of  the  acceleration  plane) 

to  the  six  planes  of  A” B'' d' D" E" F" G" H"  (the  set  Su). 

Now,  we  can  write  the  following  expression  for  ailQ(Su)'- 

it  n  it  ii  ii  ii  n  ii  n  ii  n  a  ii  ii  ii  n  ii  n  it  n  ii  ii  ii  n 

a^o(Su)  =  min[p(A  B  F  E  ),  p(A  E  H  D  ),  p{E  F  G  H  ),  p(D  C  G  H  ),  p(B  C  G  F  ),  p(A  B  C  D  )](208) 

where  p(A"b"F/'e'  ’)  is  the  (perpendicular)  distance  from  O  to  plane  A" B"f"e"  and  similarly  for 
p(A" E"H" D"),  p(E" F"g" H"),  p(D" d' G" H" ),  p(B" d' d' f" ),  p(A"B"d'D"),  all  assumed  positive  by 
definition.  From  the  geometry,  we  can  write, 

p(AB"f"e"), piD'CGH)  =  p(AB'f”e")  ±  p(K,  p{).  (209) 

(Comment:  For  example,  p(A" B" F" E")  =  p(A' B' F" )  +  p(AT,pi)  and  p(D"c"G'V)  =  piD'dd'd')  - 
p(K,pi)\  the  correct  choice  of  signs  will  depend  on  the  direction  of  the  translation  but  as  will  be  shown 
below  we  do  not  have  to  worry  about  the  correct  choice  of  signs.) 

Similarly, 


it  _//  n  ii  //  ii  ii  it 


p(A  D  H  E  ),p(B  C  G  F  )  =  p(A  D  H  E  )  ±  p(K,p2\  (210) 

p(e"  f"  g"  h"  ),  P(a"  b"  d' d"  )  =  p(e'f'g'h')±p(k,p2 ),  (21 1) 

(The  above  comment  holds  for  (210)  and  (211),  too.) 

Combining  equations  (208),  (209),  (210)  and  (211),  we  obtain 

auotfu)  =  min[p<A' B  F' E  )  ±  p(K,  Pl),  p<A  D  H  E  )  ±  p(K,  &),  p(E  F  G  H)  ±  (K,  p,)].  (212) 

Since  all  distances  p 0  in  the  above  equation  are  positive  by  definition,  we  can  rewrite  the  above  equation 


an(Su)  =  min(p(/t  B  F.E  )  -  p(X,  pi),  p(A  D  H  E  )  -  p(K,  pz),  p{E  F  G  H  -  p(K ,  pj)]. 
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Substituting  equations  (56)  through  (58)  and  (205)  through  (207)  into  (213),  we  obtain  the  required 
result  (192). 

Equation  (213)  clearly  demonstrates  that  the  isotropic  acceleration  Oi,0(5u)  for  any  state  u  f  0  is  less 
than  atto(Sr)  =  min [^a! B' F' E!),^ D' rf E'),p{E' F' G' rf)).  In  fact,  if  p(K,  Pi).  p(K,  pz)  and  p{K ,  p3) 
arc  sufficiently  large  (equivalently,  the  “nonlinearities"  *i.  k2  and  fc3  are  sufficiently  “large”),  we  may  not 
have  any  isotropic  acceleration.  The  necessary  tmd  sufficient  conditions  for  the  existence  of  the  isotropic 
acceleration  can  be  obtained  either  from  (213)  or  (192).  From  (192),  we  obtain  the  following  three 
necessary  and  sufficient  conditions  for  the  existence  of  the  isotropic  acceleration: 

r,*!  det(A)|  >  |(<J22tf33  -  <Z23tfS2)*l  +  (013032  -  fll2fl33)*2  +  (*2 12*223  -  <222*2 1 3 )*3 1  (214) 

r^ldetfA)!  >  )(a21<233  —  a23<*3l)^l +(flllfl33  —  fll3fl3l)^2  +  (flnfl23  -  fl21al3)^3|  (215) 

det(A)|  >  |  (<22 1*232  -  <222*231)^1  +  (*212*231  -  anfl32)^2  +  (<211*222  -  *212*221)^3 1  (216) 

These  are  exactly  the  necessary  and  sufficient  conditions  expressed  in  (189),  (190)  and  (191)  of  result  2. 
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5.4  Local  acceleration  properties 

At  any  given  (local)  configuration  q  in  the  workspace,  the  following  questions  are  of  theoretical  and 
practical  importance. 

•  Magnitude  of  the  maximum  acceleration  at  any  configuration  q  in  the  workspace 

•  Magnitude  of  the  isotropic  acceleration  at  any  configuration  q  in  the  workspace 


Result  1:  The  local  maximum  acceleration  flm»x,ioc*i  of  a  spatial  three  degree-of-freedom  manipulator  at 
a  given  configuration  q  is  specified  by 


(Um«x,loc»l)lb  fi  Umax, local  —  (Umax, local  )ub  (217) 

where  (Umax, local )ib  is  given  by  (188)  with  *i(q,  q),  k2(q,q).  and  ki(q,q)  evaluated  at  that  joint 
variable  vector  q  which  maximizes  /(ft,  ft,  ft)  in  equation  (107),  and 

(Utnax.local)ub  =  Um»x(5q)  +  UmtxC^r)  (218) 

where  am„(Sq)  is  given  by  (107)  and  amax(5T)  is  given  by  (77). 

Result  2:  The  local  isotropic  acceleration  auojocti  at  a  given  configuration  q  is  specified  by 


^iso,  local  (Su) 


=  min 


p(A'B'F'E ’)  -  /w(x(Sq),/?i) 
OiA'D’H’E')  -  Pm„(x(Sq),p2) 
P(A  B  C?D)  —  Pmax(x(Sq),P3) 


(219) 


where  p(A!b'f'e!\  p^D'h'e!)  and  piA'B'cf  D  )  are  given,  respectively,  by  equations  (56)  through 
(58),  and  where  Pm«x(x(Sq),Pi),  Pmax(x(Sq),p2).  and  pm»x(x(Sq),p3)  arc  given  by  equation  (109). 


Proof  of  result  1: 

The  local  maximum  acceleration  amtx  is  the  maximum  acceleration  over  all  possible  state  acceleration 
sets  5U  at  a  given  position  q  in  the  workspace.  Therefore,  Omxx  can  be  written  as 

Umix.iocxi  ~  max(Uqe/r5u).  (220) 
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It  is  not  possible  to  find  an  exact  analytical  expression  for  dm**, local-  However,  we  can  find  an  upper 

bound  and  lower  bound  which  are  very  good  approximations  to  oni* 

Corresponding  to  every  point  P  of  the  set  S<,,  we  have  a  state  acceleration  set  SU(P).  Let  P'  be  the 
furthest  point  (from  the  origin)  of  Sq,  and  let  SU(P')  be  the  corresponding  state  acceleration  set.  Let  the 
set  S'uCP' )  obtained  by  rotating  the  set  5U(P  )  about  P'  till  the  longest  diagonal  of  5U  is  collinear  with  the 
line  OP'  joining  the  origin  to  the  furthest  point  P'  of  Sq.  A  lower  bound  for  OouX,ioc«i  is  given  by  the 
distance  of  the  furthest  vertex  of  Sn  from  the  origin,  vi2 

(^mu tiocaj )tb  =  max[d(OA"  ),  J(OB" ),  d(OC" ),  d{OD" ),  d{OE  ),  d(OF" ),  d(OC" ),  d{OH  )],  (221) 

and  an  upper  bound  for  Oi*o,ioc«i  is  given  by 

jooi )ub  =  dfOP )  +  d(A  P  ),  (222) 

(4tuxJocal)ub  =  ^nnxCSq)  +  (223) 

Combining  (221)  with  equation  (197)  through  (204),  we  obtain  equation  (188).  The  values  of  k\,  kz 
and  *3  in  (188)  correspond  to  the  furthest  vertex  P'  of  5q  from  the  origin,  i.e.,  to  that  joint  variable  vector 
q  which  maximizes  l(if  j,  <72,  in  equation  (107).  This  is  simply  a  matter  of  computing  !(<?],  <72,  <ts)  at 
the  thirteen  vectors  defined  in  subsection  5.2  and  determining  which  of  these  thirteen  vectors  maximizes 
l(,q  1 ,  02,  ft)-  This  completes  the  determination  of  the  lower  bound  (amM,ioc*i)/fc. 

Substituting  fordmaxCSq)  and  nnux(Sr)  from  equations  (107)  and  (77),  respectively,  we  obtain  equation 
(218)  for  the  upper  bound  (Om.,  Thus,  Result  1  is  proved. 

Proof  of  result  2: 

The  local  isotropic  acceleration  is  obtained  in  the  following  steps. 

1.  The  maximum  possible  isotropic  acceleration  is  obtained  when  q  =  0  and  is  equal  to  alto(ST)  as 
given  by  equation  (78). 

2.  Every  state  acceleration  set  will  have  an  isotropic  acceleration  which  is  less  than  that  given  by 
(78)  because  the  “nonlinearities"  effectively  reduce  the  isotropic  acceleration.  The  resulting  state 
isotropic  acceleration  is  flj,o(Su)  which  is  given  by  equation  (213). 
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3.  The  local  isotropic  acceleration  ai*o,ioeai  is  the  magnitude  of  the  smallest  state  isotropic  acceleration 
at  a  given  local  configuration  q,  i.e. 


^Uo, local  =  min  UiioCSu)- 

qe£ 


(224) 


4.  Using  equation  (213)  and  (224),  we  can  express  the  local  isotropic  acceleration  Oj*,, local  as 


Quo,  local 


/  i  I  I 


I  _  I  /  I 


min  min [p(A  B  F  E  )  -  p(K,pi),  p{A  D  H  £  )  -  p(K,pi),  p(E  F  G  H  )  -  p(K,  pj)] 


/  /  i  J 


/  t  i  i 


/  /  /  l 


min[min{p(A  B  F  E  ) -  p{K,pi)},  min{p(A  DUE  ) - p{K,pi),  min{p(£  F  G  H  )-  p(AT,p£S$3) 
q  qer  q€f 


5.  Since  p(A' B' F’ E' ),  p(A'd'h'e')  and  piE'F'G'  H1)  are  constants  for  a  given  manipulator  and  given 


actuator  constraints,  (225)  can  be  written  as 


Oiw,k>Mi  =  min[p(A  B  F  E)~  max  piK,  p\ ),  p(A  D  H  E  )-  maxp(K,p2 ),  p(E  F  G  H  )—  maxpt/T.pj)].  (226) 


where  mzx[p(K,p\j\  is  the  distance  from  the  plane  p\  to  the  element  of  Sq  furthest  away  from  p\ 
which  we  denoted  in  subsection  5.2  by  pm..(x(Sq).p->).  max[p(K,p2)]  is  the  distance  from  the  plane 
P2  to  the  element  of  Sq  furthest  away  from  pz  which  we  denoted  in  subsection  5.2  by  Pmix(*(Sq),p2) 
and  max[p(K,pj)]  is  the  distance  from  the  plane  pz  to  the  element  of  Sq  furthest  away  from  pz 
which  we  denoted  in  subsection  5.2  by  /w(x(Sq)>P3).  We  can  therefore  write 


maxp(AT,pi)  =  /w(x(Sq),Pi) 

(227) 

m&xp(K,pz)  =  /W(x(Sq),P2) 

(228) 

ma.xp(K,pz)  =  pmtx(x(Sq),pz) 

(229) 

Combining  (226),  (227),  (228)  and  (228),  we  obtain  the  required  result  (219).  (Note  that  all 
quantities  in  (219)  have  been  analytically  determined  earlier.) 
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6  Example: 

To  demonstrate  the  ease  of  applicability  of  the  general  acceleration  set  theory  for  spatial 
manipulators  developed  in  the  previous  sections,  we  have  written  simple  computer  codes  to  generate  the 
acceleration  properties  of  the  various  acceleration  sets  for  a  common  type  of  3  d.o.f.  spatial  manipulator 
which  is  shown  in  Figure  9  and  whose  o  kinematical  and  dynamical  equations  are  given  in  the  Appendix. 
(The  axis  of  joint  1  in  Figure  9  is  vertical).  The  actual  geometric  and  inertia  parameters  used  in  the  example 
are  given  in  Table  3.  The  dynamical  equations  have  been  derived  using  Kane's  dynamical  equations  (Kane 
and  Levinson  1983;  Kane  and  Levinson  1985;  Desa  and  Roth  1985). 

The  configuration  chosen  was  qi  =  o,  q2  =  45*  and  q3  =  45* 

The  joint  variable  rate  ("joint  velocity")  constraints  are 

q>  £  q»  =1  rad/s  ;  i»  1,2,3  . 


The  torque  constraints  are 

ti  S  tio  ,  i  *  1,2,3  . 

Tio  may  be  thought  of  as  the  size  (or  maximum  torque  rating)  of  the  actuators;  the  numerical  values  of  xio . 
(i  =  1,2,3),  are  given  in  Table  3. 

The  properties  of  the  state  acceleration  set  were  computed  at  qi  =  o  ,  q2  =  45*  and  q3  =  45‘; 
qi  =  1  rad/s,  <*2=  1  rad/s  qs  =  - 1  rad/s 


In  order  to  show  how  the  theory  might  be  used  for  design  purposes  we  have  determined  the 
acceleration  properties  for  three  cases  (Table  4).  Five  acceleration  properties  have  been  determined  in  each 
case:  the  maximum  and  isotropic  acceleration  of  the  set  Sx,  the  maximum  and  isotropic  accleration  of  the 

state  acceleration  set  and  the  (local)  isotropic  acceleration  at  the  configuration  (0, 45*,  45*  )T. 

In  all  three  cases  the  sizes  of  the  first  two  actuators  remain  constant  (tio  =  35  N-m  and  T2o  =  8.2 
Nm)  and  the  size  of  the  third  actuator  (driving  link  3)  is  varied.  In  Case  1  of  Table  4  (X30  =  0.17  N-m),  the 
end-effector  does  not  have  either  a  state  or  local  isotropic  acceleration).  When  the  size  of  actuator  3  is 
increased  to  0.4  N-m  (Case  2),  we  obtain  a  state  isotropic  acceleration  of  0.93  m/s^  but  the  local  isotropic 
acceleration  is  very  small  0.03  m/s2.  Therefore  for  given  xio  andx2o  .ho  must  be  greater  than  0.4  N-m  in 
order  that  we  may  have  a  local  isotropic  acceleration  at  the  specified  configuration  q.  Case  3  shows  that  for 
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reference  point  P 


<>! 

Figure  9:  Schematic  diagram  of  a  three  degree -of-freedom  manipulator 


actuator  size  *30  of  0.6  N-m  we  have  a  local  isotropic  acceleration  of  1.61  m/s2.  The  designer  must  then 
decide  (from  past  experience)  whether  this  magnitude  of  isotropic  acceleration  is  reasonable. 


1 .  These  computations  can  be  repeated  for  various  configurations  in  the  workspace  after  which 
decisions  can  be  made  regarding  actuator  sizes. 

2.  Algorithms  for  the  determination  of  minimum  actuator  sizes  to  achieve  a  desired  isotropic 
acceleration  are  given  in  (Desa  and  Kim  1989-2)  for  the  planar  case.  The  extension  to  the  spatial 
case  is  relatively  straightforward. 


>0 

II 

0 

b 

12  *  0-303 

&3  =  0.254 

(m) 

u 

1— » 

11 

0 

b 

82  =  0.196 

83  =  0.094 

(m) 

mi  *  3.5 

m2  *  2.259 

m3  =  1.129 

(kg) 

II  =  1.2 

h - 

Ki  =  - 

(kg-m2) 

12  =  .129 

J2  =  -129 

K2  s  0 

(kg-m2) 

I3  =  .003 

J3  *  .003 

K3  H  0 

(kg-m2) 

Table  3:  Parameters  for  the  spatial  manipulator  (see  Figure  9  and  the  Appendix). 


• 

Actuator  Torques 

Acceleration 

Properties 

Case 

*10 

(N-m) 

*20 

(N-m) 

*30 

(N-m) 

Amax(Sr) 

(m/s2) 

Afnax(Su) 

(m/s2) 

Aiso,  local 
(m/s2) 

1. 

35 

8.2 

0.17 

20.3 

1.35 

23.7 

0 

0 

2. 

35 

8.2 

0.4 

25.06 

3.16 

29  A 

0.93 

0.03 

3. 

35 

8.2 

0.6 

30.3 

4.75 

33.9 

2.51 

1.61 

Table  4:  Acceleration  Properties  for  the  manipulator  of  Section  6. 
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7  Summary  andCondustaos 


In  this  paper,  we  extended  the  acceleration  set  theory  for  planar  manipulators,  developed  in  (Desa  and  Kim, 
1989- 1),  to  spatial  manipulators.  As  in  the  planar  case  we  have  accomplished  the  following: 

•  Given  the  kinematical  and  dynamical  equations  of  a  manipulator,  we  have  defined  die  image  set  St 
corresponding  to  the  set  T  of  actuator  torques,  and  the  image  set  Sq  corresponding  to  the  set  F  of  the 
joint  variable  rates.  We  have  also  defined  the  state  acceleration  set  Su  at  a  specified  point  u  in  the 
state  space. 

•  We  have  determined  the  image  sets.  St  and  Sq ,  and  the  state  acceleration  set  Su- 

•  We  have  characterized  the  image  sets  St  and  the  state  acceleration  set  Su  by  their  maximum  and 
isotropic  acceleration.  The  image  set  Sq  has  been  also  characterized  by  its  maximum  acceleration. 

•  At  a  configuration  or  position,  q,  in  the  workspace,  we  have  established  two  local  acceleration 
properties:  the  local  maximum  acceleration  and  the  local  isotropic  acceleration.  The  local  maximum 
acceleration  specifies  the  magnitude  of  the  maximum  acceleration  of  (a  reference  point  on)  the  end- 
effector.  The  local  isotropic  acceleration  specifies  the  magnitude  of  the  maximum  available 
acceleration  of  the  end-effector  in  all  directions. 

We  then  demonstrated  the  application  of  the  acceleration  set  theory  for  spatial  manipulator  to  the  3 
d.o.f.  spatial  manipulator  shown  in  Figure  9. 

We  have,  therefore,  demonstrated  the  hypothesis  which  we  stated  in  the  introduction,  i.e.,  that  the 
analytical  properties  of  acceleration  sets  can  be  determined  from  the  properties  of  the  linear  and  quadratic 
mappings  which  define  them  (the  acceleration  sets).  Furthermore,  the  acceleration  properties  of  interest  - 
especially  the  isotropic  acceleration  -  have  been  determined  in  terms  of  the  manipulator  parameters,  the 
torque  limits  and  joint  variable  rate  ("joint  velocity")  limits.  These  results  can  therefore  be  applied  to 
manipulator  design  problems  as  demonstrated  in  (Desa  and  Kim,  1989-2). 
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Appendix:  Functional  relationships  for  the  spatial  3  cLaf.  manipulator  of  Figure  9. 
Notation-  (See  Figure  9) 

*l-a2>  *3 :  dextral  orthogonal  set  of  unit  vectors  fixed  in  link  1  and  parallel  to 

the  central  principal  moments  of  inertia  of  link  1. 
b1.b2.b3  :  dextral  orthogonal  set  of  wit  vectors  fixed  in  link  2  and  parallel  to 

the  central  principal  moments  of  inertia  of  link  2. 
ci.c2.c3:  dextral  orthogonal  set  of  wit  vectors  fixed  in  link  3  and  parallel  to 

the  central  principal  moments  of  inertia  of  link  3. 


fii: 
Q3: 
*2  : 
*3: 
mi  : 
m2  : 
m3  : 


length  of  link  2 
length  of  link  3 

distance  from  joint  axis  of  link  2  to  center  of  mass  of  link  2 
distance  from  joint  axis  of  link  3  to  center  of  mass  of  link  3 
mass  of  link  1 
mass  of  link  2 
mass  of  link  3 


11.  Ji,  Ki ;  central  principal  moments  of  inertia  of  link  1  for  axes  parallel  to 

ai.  a2  and  a3  respectively.* 

12.  J2,  &2  •*  central  principal  moments  of  inertia  of  link  2  for  axes  parallel  to 

bi.l>2  and  b3  respectively. 

13. J3.K3:  central  principal  moments  of  inertia  of  link  3  far  axes  parallel  to 

ci,  C2  and  C3  respectively. 

(The  input  and  output  variables  are  as  defined  in  section  3.1) 


L  Jacobian  matrix 

The  joint  velocity  is  related  to  the  velocity  *  of  the  point  P  in  Cartesian  space  by  the  relation 
i*  Ji 


The  Jacobian  matrix  J  for  a  spatial  three  degree-of-freedom  manipulator  in  Figure  9  is  the  following: 


hi  Jli  hi 
0  hi  ha 
hi  hi  hi 


where 


hi  *  an?i(/2Cos$2  +  bcos(<fc  +  f3)) 
j\i  *  -  cos  qi(k  sin  <72  +  /3  sin(<?2  + 
ju  *  —h  cos  sin(<72  +  qi) 

}n  »  fecosft  +  /3cos(^2  +  9j) 
ha  *  h  cos(?2  +  <73) 


1  For  link  1,  since  the  first  joint  axis  is  parallel  to  aj,  only  the  principal  moment  Ii  is  of  importance  in 
the  dynamic  equations. 
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M  *  -  cos  q\(h  cos cosOfr  +  $3)) 
h 2  *  “Sin?i(/2sin^2  +  /3Sin(ft-*-ft)) 

/»  *  —  sin  q\  h  sm(qz  +  qi) 

When  the  above  relation  is  differentiated  with  respect  to  the  time,  we  obtain  the  following  equation, 

S*Jij  +  j<j  =  J$-F<<l>2--G[<U2  (230) 

where  F,  G  are  matrices  with  the  following  elements: 

0  0  /,  3 

F=  0  fa  0 
fi  t  fil  fa 

where 

/l3  =  COSflj/3  COS(<?2  +  <73) 

/22  *  /2sin<72  +  /3sin(<72  +  <73) 

/ii  *  -  sin  q\(k  cosqi  +  h  cosfo  +  43)) 

/32  ■  sin  <7i(/2  cos  <?2  +  /3  cosfo  +  <73 )) 

/33  =  sin  <71/3  cos(<72  +  (?3)  , 

and 

0  *12  0 
G  =  0  J22  0 

0  *32  0 

where 

*12  *  COS<7i/3COS(<72  +  <73) 

*22  *  fcsinOfe  +  ft) 

*23  *  Sin?i/3C0S(?2  +  ?3) 
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2.  Dynamic  equation 


The  dynamic  behavior  of  the  manipulator  is  described  by  the  following  equation: 

Dq  +  u  <  q  >2  +W[q]2  +  p  *  r. 

The  components  of  matrices  D,  U,  and  W  are  as  follows: 

[  dn  0  0  I 


D  = 


0  dzz  dn 

0  di2  433 


where 


d\\  *  II  +(/2  +  m20^)C0S2qi*/3C0S2(<y2+<?3)+/n3(/2C0S^2 -f  ftCOS(ft  +  ft))2 

dn  *  Ji  +■  ntidx  +  /i  +  013(03  ♦  2ft/2  cos  ft  +  /|) 

4  .  *  h  +  "*3(03  +  03/2  cos  $3) 


<*32  *  dn 
dn  *  /j  +  01303 


U  = 


0  0  0 
U21  0  1423 

ftl  1432  0 


where 


U21  *  (/2  +  m2(^)  cos  <72  sin  <72  +  /j  cos(ft  +  <73)  sin(ft  +  ft)  + 

+  m3(/2  cos  ft  +  ft  cos(ft  +  ft))(/2  sin  ft  +  G3  sin(ft  +  ft)) 

M23  a  /nj/j  ft  Sin  ft 

fti  «  /3Cos(ft  +  ft)sin(ft4-ft)  +  /n3(/2cosft +ftcos(ft  +  ft))ftsin(ft  +  ft) 
<432  *  «23 

J  W])  0  W13  ] 


W* 


0  W22  0 
0  0  0 


(23D 
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where 


wn  =  —[(/a  +  mx%)  cos  ft  sin  ft  +  /3  eos(ft  +  ft)  sin(ft  +  ft)  + 

+  W3(/2  cos  ft  +  ft  cos(ft  +  ft)Xfe  sin  ft  +  ft  sin(ft  +  ft))] 
wi3  =  -[/3C0s(ft +  ft)sin(ft  +  ft)-*-m3(/2COSft  +ft  cos(ft +  ft))ft  sin(ft +  ft)] 
W22  =  m3/2ftsinft 


The  nonlinear  vectors,  <  ([  >2  and  ft]2  are  as  follows: 


<  4  >2= 


4?' 

*2 

4i 


ft]2 


2ft  ft 
2ft$3 
2ftft 


0 


P  = 


P2 

P3 


where 


P2  *  [m2a2 cos  ft  +  m3(/2cosft  +  ft  cos(ft  +  ft))]g 
P3  *  m3(/2COSft  +  ftCOS(ft  +  ft))£ 


3.  Acceleration  equation 

The  expression  for  the  acceleration  of  the  end-effector  is  as  follows: 
*  =  Ar  +  B  <  4  >2  +Nft]2  ♦  s 


(232) 
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where 


A  -  JD-1 
B  *  -AU  +  F 
IVl  *  —AW  +  G 
s  =  -Ap 


(233) 
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